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ABSTRACT 


The  study  of  human  driving  of  automotive  vehicles  is  an  important  aid  to  the 
development  of  viable  autonomous  vehicle  navigation  techniques.  Observation  of 
human  behavior  during  driving  suggests  that  this  activity  involves  two  distinct 
levels,  the  conscious  and  the  unconscious. 

Conscious  actions  relate  to  the  logical  behavior  of  a  driver  such  as  stopping 
the  vehicle  when  a  traffic  light  is  red.  siowing  down  the  vehicle  when  it  turns  a 
bend.  etc.  Such  behavior  can  be  described  using  natural  human  language.  The 
unconscious  actions  of  a  driver  are  much  less  obvious.  There  are  many  such 
activities  occurring  while  we  are  driving  a  vehicle  to  a  particular  destination.  One 
of  the  important  unconscious  efforts  involves  the  selection  of  successive  points  on 
the  road  to  steer  the  vehicle  towards  in  order  to  achieve  the  desired  road-following 
behavior.  This  research  work  attempts  to  mimic  this  unconscious  behavior 
through  the  use  of  a  computer  simulation  model. 
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I.  INTRODUCTION 


A.  GENERAL  BACKGROUND 

Today  there  are  many  robots  employed  all  over  the  world,  especially  in  the 
USA  and  Japan,  to  do  various  kinds  of  industrial  work.  The  beneriis  realizable 
through  the  use  of  these  robots  are  numerous,  easily  attained,  and,  most 
importantly,  proven.  However,  most  of  these  industrial  robots  either  lack  any 
external  sensory  mechanisms  or  have  only  a  few  unsophisticated  sensors  Reis.  1- 
3j. 

Robots  that  do  not  have  any  external  sensors  normally  operate  from  a  fixed 
position.  They  are  programmed  to  perform  a  series  of  movements  to  accomplish  a 
desired  task.  Once  programmed,  these  robots  repeat  the  programmed  movements 
as  many  times  as  desired,  accurately  and  precisely,  regardless  of  the  external 
environment. 

The  other  kind  of  robot,  the  kind  equipped  with  a  few  unsophisticated 
sensors,  is  able  to  perform  limited  sensing  of  the  environment.  Such  a  robot  is 
capable  of  adapting  to  simple  and  small  changes  in  the  operating  environment 
such  as  stopping  when  an  unexpected  object  crosses  into  its  path. 

With  the  advent  of  the  information  age  and  microprocessor  technologies,  yet 
another  kind  of  robot  is  becoming  realizable.  These  kind  of  robots  are  called 
autonomous  robots.  Such  robots  are  capable  of  making  their  own  decisions  and 
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adapting  quickly  and  safely  "on-the-fly"  to  accomplish  a  mission  [Refs.  4-5).  Such 
robots  can  either  operate  from  a  fixed  position  or  from  a  mobile  platform.  In  the 
case  of  mobile  robots,  the  system  can  also  be  capable  of  avoiding  obstacles  along 
its  navigation  path.  In  this  respect,  a  human  being  can  be  considered  to  be  an 
extreme  example  of  an  ideal  autonomous  robot. 

Humans  receive  information  about  their  environment  from  two  groups  of 
sensors  [Ref.  6j.  One  group  provides  conscious  sensing  and  the  other  group 
provides  subconscious  sensing.  The  first  sensing  group  comprises  the  five  basic 
human  sense  organs:  ears.  nose,  mouth,  touch  and  eyes.  Each  of  these  sensors  has 
a  specialized  processor  attached  to  it  which  analyzes  the  sensor  input.  This  is 
especially  so  with  the  eyes  which  provide  humans  with  one  of  the  most  complex 
vision  systems  found  in  nature.  A  human  is  able  to  identify  different  objects 
under  a  wide  variety  of  environmental  conditions  such  as  varying  viewing 
distance,  viewing  angle,  brightness,  contrast,  etc. 

The  second  group  of  sensors  provides  proprioceptive  information,  which 
according  to  Thring  [Ref.  7],  gives  an  overall  internal  model  of  our  body.  It  also 
provides  inertial  information  from  the  vestibular  system  that  senses  body 
orientation,  balance,  and  rotation. 

All  information  received  by  the  five  basic  sensors  is  sent  to  the  highly  complex 
cerebral  cortex  which  acts  as  the  central  processor  of  the  entire  system  [Ref.  7]. 
After  processing  the  various  sensory  inputs,  the  cerebral  cortex  sends  signals  to  all 
parts  of  the  body  including  the  cerebellum  [Ref.  7], 
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The  cerebellum  is  the  chief  coordinator  of  our  motion  system.  Besides 


receiving  information  from  the  cerebral  cortex  about  what  movements  are 
required,  it  also  receives  information  from  the  vestibular  system  and  the 
proprioceptors  in  order  to  be  able  to  command  muscular  movements  [Ref.  7]. 

The  above  oversimplified  discussion  of  an  ideal  autonomous  robot  is  intended 
to  illustrate  the  complexities  involved  in  building  a  real  autonomous  mobile  robot. 
It  must  have  a  very  elaborate  and  sophisticated  sensory  mechanism,  numerous 
high-speed  information  processors  working  in  parallel,  and  a  very  large  and 
sophisticated  controlling  software  system  in  order  to  achieve  complete  autonomy. 

Finally,  human  beings  achieve  their  mobility  mainly  througn  a  pair  of  legs, 
but  this  is  not  necessarily  so  for  an  autonomous  mobile  robot.  There  are  many 
ways  for  an  autonomous  mobile  robot  to  achieve  mobility  on  land.  For  local 
motion  the  alternatives  are  wheeled  systems,  tracked  systems  and  legged  systems 
[Ref.  8].  Of  the  three,  the  legged  system  is  probably  the  most  flexible  but  also  the 
least  understood  method.  There  is  a  great  deal  of  research  currently  underway  on 
walking  machines  [Refs.  8-12]. 

Several  attempts  to  build  an  autonomous  wheel-based  mobile  robot  were 
carried  out  as  early  as  the  1960’s  [Ref.  13].  However,  none  of  this  research  was 
able  to  deliver  a  completely  autonomous  robot.  Some  of  these  earlier  works  will 
be  discussed  in  Chapter  II.  A  number  of  research  projects  that  are  currently  being 
carried  out  seem  to  be  much  more  successful  than  their  predecessors.  The  main 
reason  for  this  could  be  that  their  predecessor’s  failures  had  prompted  several 
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related  smaller  research  studies  in  areas  such  as  sensor  hardware,  machine  vision, 
and  computer  architectures  to  be  carried  out  instead.  The  results  of  these  research 
efforts  are  now  being  consolidated  into  the  latest  autonomous  vehicle  projects. 

One  of  the  areas  which  has  received  relatively  little  attention  in  previous  and 
current  research  work  on  autonomous  vehicles  is  that  of  human  navigation  and 
driving.  This  area  may  be  pertinent  to  the  viability  of  the  future  of  autonomous 
vehicles,  especially  those  on-road  and  wheeled-based.  The  objective  of  this  work 
is  to  investigate  and  mimic  a  human  driver  driving  a  conventional  automobile. 

3.  ORGANIZATION 

Chapter  II  reviews  some  of  the  early  research  projects  on  autonomous  mobile 
robots  done  in  the  late  1960’s.  Much  of  this  work  provides  the  necessary 
background  for  several  autonomous  vehicle  research  projects  that  are  currently 
being  carried  out.  Some  of  these  later  research  projects  are  also  summarized  in 
this  chapter. 

The  objective  of  this  research  work  in  relation  to  autonomous  vehicles  is 
discussed  in  greater  depth  in  Chapter  III.  In  this  chapter,  some  of  the  basic 
aspects  of  conventional  automotive  vehicle  mechanics  are  also  explained.  This  is 
to  show  that  the  graphics  simulation  built  for  this  study  ignores  many  complex 
interactions  that  occur  between  a  vehicle  and  its  environment  when  the  vehicle  is 
moving.  That  is,  a  number  of  simplifying  assumptions  are  made  in  this  chapter 
so  as  to  make  the  graphics  simulation  more  feasible  within  the  time  constraints  of 
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this  study.  The  mathematical  model  used  for  the  graphics  simulation  is  also 
derived  and  described  in  Chapter  III. 

The  entire  graphics  simulation  is  implemented  in  C.  The  functions  of  the 
various  modules  developed  for  the  simulation  are  described  in  Chapter  IV.  This 
chapter  elaborates  the  overall  software  design  strategy  and  the  important  issues 
that  must  be  addressed  when  the  software  is  to  be  improved  or  modified.  The 
procedure  for  changing  various  vehicle  gains  is  also  described  in  this  chapter. 

Numerous  experiments  were  conducted  with  the  simulation  moaei  to  support 
the  validity  of  this  work  and  the  mathematical  model  used.  Chapter  V  records 
and  explains  the  results  of  all  the  experiments  conducted  using  the  simulation 
model. 

The  last  chapter.  Chapter  VI,  summarizes  the  work  done  and  its  benefit  to 
autonomous  vehicle  research.  Suggestions  about  some  possible  extensions  to  this 
research  work  are  also  given.  This  additional  work  would  make  the  present  study 
more  comprehensive  and  substantiative. 

Chapter  VI  is  followed  by  a  list  of  reference  material  used  for  this  study. 
Finally,  the  graphics  simulation  source  code  is  attached  as  an  appendix. 
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II.  SURVEY  OF  PREVIOUS  WORK 


A.  INTRODUCTION 

Research  in  autonomous  systems  began  as  early  as  the  late  1960!s  Ref.  13] . 
Many  of  these  early  research  efforts  did  not  fully  materialize,  mainly  because  of 
the  technological  limitations  existing  at  that  time.  The  outcome  of  these 
investigations,  however,  indicated  that  the  complexity  involved  in  certain  areas 
such  as  image  processing,  scene  analysis,  planning,  etc.,  required  more  work  before 
further  attempts  to  build  autonomous  systems  could  continue. 

Since  then,  major  advances  and  significant  breakthroughs  in  several  areas  of 
technology  have  made  many  tasks  which  were  difficult  to  implement  or  even  not 
possible  in  the  1960’s  become  more  feasible.  Improvements  in  VLSI  technology 
allow  very  complex  algorithms  to  be  constructed  in  hardware.  Miniaturization 
reduces  the  overall  weight  of  vehicle  controllers  and  also  greatly  increases 
electronic  speed.  New  techniques  in  image  processing  and  vision  analysis  enable 
very  complex  images  to  be  examined.  More  details  can  now  be  extracted  from 
images  with  these  techniques  than  was  previously  possible  [Refs.  14,15].  New 
computer  architectures  provide  the  massive  computation  power  required  for  real¬ 
time  processing  [Refs.  16,17].  Large  amounts  of  sensor  data  and  images  can  now 
be  reduced  quickly  to  facts  that  are  needed  for  autonomous  decision  making.  New 

techniques  developed  in  artificial  intelligence  provide  more  opportunities  for 

14 


autonomy.  These  techniques  are  capable  of  handling  more  complex  knowledge 
representations  and  manipulations  [Refs.  18,19]. 

B.  AUTONOMOUS  MOBILE  ROBOTS 
1.  Shakey  (1967) 

The  Shakey  project  represented  one  of  the  earliest  attempts  to  study 
autonomous  navigation  using  a  mobile  robot.  Shakey  was  developed  by  Stanford 
Research  Institute  to  study  the  real-time  control  of  a  robot  system  that  interacts 
with  a  compiex  environment  [Ref.  13] . 

Shakey  moved  around  with  two  independently  controlled  wheels  mounted 
on  both  sides  of  the  vehicle.  It  had  a  rotatable  "head"  which  carried  a  vidicon 
camera  wnich  provided  "sight"  to  Shakey.  This  head  was  aiso  provided  with  an 
optical  range-finder.  Several  touch  sensors  were  attached  around  the  vehicle  for 
collision  detection  and  avoidance. 

An  SDS-940  computer  was  used  to  control  the  behavior  of  Shakey  using 
two  radio  links.  One  link  was  used  for  telemetry  and  the  other  link  was  used  for 
transmission  of  the  visual  input  from  the  camera  to  the  computer. 

Another  significant  feature  of  this  early  attempt  at  an  autonomous  system 
was  its  man-machine  interface.  Commands  could  be  given  in  primitive  English 
that  was  analyzed  and  translated  into  the  appropriate  machine  actions  by  a  LISP 
program  [Refs.  20,21],  This  feature  also  included  a  simple  question-answer 
capability. 
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Shakey’s  world  consisted  of  a  grid  model  and  a  property  list  model.  The 
grid  model  is  a  hierarchically  organized  system  of  four-by-four  grid  cells.  This 
model  was  constantly  updated  by  the  vision  system  and  it  served  primarily  as  a 
free  space  map  used  for  path  planning  and  navigation. 

The  property  list  model  kept  track  of  the  various  characteristics  of  the 
objects  in  its  woria.  Information  about  each  object  such  as  its  coordinates,  size, 
etc.,  gave  Shakey  a  better  sense  of  the  world.  Using  this  model.  Shakey  could 
navigate  to  a  known  object  described  in  the  property  list.  The  model  also 
provided  information  for  coliision-free  navigation  around  the  environment. 

2.  Stanford  Cart  (19721 

The  research  work  for  the  Stanford  Cart  was  carried  out  in  the  Stanford 
University  Artificial  Intelligence  Laboratory'  [Ref.  22].  The  only  sensor  installed  on 
the  cart  was  a  camera  remotely  linked  to  a  DEC  KL-10  computer.  The  KL-10 
computer  functioned  as  the  vehicle  controller  and  also  as  an  image  processor. 
After  each  cart  move,  it  received  nine  scene  images  from  a  slide-mounted  camera, 
each  taken  from  a  different  camera  position.  Distinctive  features  were  extracted 
from  the  first  image  and  this  information  was  used  with  the  rest  of  the  images  to 
perform  a  3-D  analysis  of  the  scene  in  front  of  the  cart. 

The  perceived  scene  was  used  by  the  navigation  software  to  compute  a 
collision-free  path  towards  the  goal.  The  collision-free  path  was  determined  by 
translating  obstacles  into  circles  on  the  floor  and  moving  the  cart,  which  is 
represented  by  a  three  meter  circle,  among  these  obstacle  circles. 
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The  Stanford  Cart  was  able  to  maneuver  successfully  in  a  cluttered 
environment.  However,  it  took  a  very  long  time  to  accomplish  its  mission  [Ref. 
22],  typically  requiring  several  hours  to  move  a  few  tens  of  meters.  This  was 
largely  due  to  the  lengthy  3-D  scene  analysis  processing  time  needed  to  determine 
the  next  cart  move. 

3.  Hilare  (1977) 

This  system  was  constructed  in  France  at  the  Laboratoire  d'Automatique 
et  d' Analyse  aes  Systemes  in  Touiouse.  The  purpose  of  the  mobile  robot  was  to 
serve  as  a  testbed  for  general  research  in  robotics  and  in  robot  perception  and 
planning  Ref.  23] . 

The  Hilare  robot  had  a  3-D  vision  system  consisting  of  a  laser  range¬ 
finder  and  a  video  camera.  A  set  of  14  ultrasonic  emitters-receivers  provided 
range  data  around  the  robot  for  distances  of  up  to  two  meters,  and  a  variety  of 
other  sensors  provided  other  information  required  for  autonomous  navigation. 

On-board  8085/86  microprocessors  were  used  by  Hilare  to  process  sensor 
inputs.  These  processors  were  remotely  connected  to  an  SEL  32-77/80  computer 
which  handled  navigation  and  coordination.  The  SEL  32  was  in  turn  remotely 
connected  to  another  larger  computer,  an  IBM  30/33,  for  higher  level  planning 
and  control.  A  remote  IBM-370  was  also  used  for  performing  complex  analysis 
tasks. 
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4.  Robart  I  (1980) 


This  robot  was  built  by  LCDR  Hobart  R.  Everett  under  the  supervision 
of  Professor  R.E.  Newton  of  the  Naval  Postgraduate  School's  Department  of 
Mechanical  Engineering.  The  aim  of  this  project  was  to  provide  a  development 
and  demonstration  platform  for  microprocessor-controlled  mechanical  systems 
Ref.  24],  Patrolling  was  the  main  role  of  this  robot.  It  was  able  to  detect  a 
variety  of  household  dangers  such  as  smoke,  fire,  toxic  gas.  flooding  conditions,  or 
intrusion,  and  was  capable  of  then  informing  the  user  appropriately. 

The  Robart  [  system  moved  around  on  a  tricvcie  wheelbase  with  front 
wheei  control.  It  had  a  rotating  Mhead"  for  scanning  the  environment.  One  of 
the  major  and  important  sensors  missing  from  this  robot  is  vision.  Lacking  vision, 
it  had  a  forward-looking  ultrasonic  ranging  unit,  a  long-range  near-infrared 
proximity  detector,  ten  short-range  near-infrared  proximity  detectors,  tactile 
feelers,  and  bumper  switches.  The  last  two  groups  of  sensors  were  used  for 
collision  detection  and  avoidance. 

To  detect  a  person,  the  robot  had  a  true-infrared  (long  wavelength 
infrared)  body  heat  sensor.  This  sensor  had  a  range  of  about  fifty  feet.  The  robot 
was  also  able  to  steer  towards  the  center  of  a  doorway  with  the  help  of  a  near- 
infrared  long-range  proximity  sensor.  It  also  had  an  assortment  of  other  sensors 
for  detecting  flooding,  fire,  smoke  and  toxic  gas  conditions. 

A  surprising  addition  to  this  mobile  robot  was  its  speech  capability  with  a 
two  hundred  and  eighty  word  vocabulary.  This  allowed  the  robot  to  use  voice 
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communication  to  inform  the  user  of  any  dangerous  conditions.  It  also  made  use 
of  this  facility  to  report  some  of  its  internal  status  information. 

The  only  computing  machinery  installed  on  Robart  I  was  a  SYM-1 
microcomputer.  This  on-board  computer  used  a  6502  microprocessor  to  which  all 
the  robots  sensors  were  connected  except  for  the  speech  synthesizer  which  had  its 
own  dedicated  processor. 

During  normal  operation.  Robart  I  moved  straight  ahead  and  stopped  at 
various  points  to  perform  surveillance.  However,  when  an  obstacle  was  detected, 
it  would  move  to  the  left  or  right  depending  on  which  was  appropriate  and  then 
continue  its  straight  ahead  movement. 

5.  Robart  II  ( 1982) 

Robart  II  is  an  improved  version  of  Robart  I  [Ref.  25].  The  basic  purpose 
of  this  new  robot  remains  the  same  as  for  Robart  I.  However,  not  only  are  there 
more  sensors  on  Robart  II.  but  the  number  of  different  types  of  sensors  installed 
also  has  been  increased.  This  machine  currently  has  six  ultrasonic  range-finders, 
fifty  near-infrared  proximity  detectors,  a  long  range  near-infrared  range-finder, 
and  various  other  sensors  used  to  detect  smoke,  fire,  toxic  gas,  flooding  conditions 
and  intrusion. 

The  previous  Robart  used  only  one  microcomputer  for  all  of  its  processing 
requirements,  which  proved  to  be  insufficient.  Robart  II  has  eight  65C02-based 
microcomputers  to  handle  the  increased  number  of  sensors  and  also  to  provide 
more  parallel  processes  to  make  it  more  responsive. 


19 


The  eight  microprocessors  of  Robart  II  are  connected  in  a  hierarchical 


fashion,  each  with  a  dedicated  function  to  perform.  The  head,  the  drive  motors, 
and  the  vision  subsystem  are  each  handled  by  a  dedicated  processor.  The  sonar 
and  the  speech  subsystem  are  each  handled  by  another  hierarchy  of  two 
processors.  All  these  processors,  however,  work  under  the  direction  of  the  SYM-1 
computer. 

C.  AUTONOMOUS  LAND  VEHICLES 

I.  EMC  Corporation  Autonomous  Vehicle  (1985) 

The  vehicle  used  in  this  project  is  a  10-ton  M113A2  armored  personnel 
carrier,  which  is  a  tracked  vehicle  rather  than  a  conventional  wheeled  vehicle. 
The  vehicle  carries  an  inertial  navigation  system,  a  vehicle  controller  computer,  a 
sonic  imaging  sensor,  and  a  master  control  computer.  Beside  this,  a  remotely 
located  control  trailer  contains  a  Symbolics  3600  Lisp  machine  for  the  Planner 
software,  a  Sun  workstation  for  the  Mapmaker-Observer-Pilot,  an  IBM  PC  for 
sonic-sensor  post-processing,  and  appropriate  communications  equipment  [Ref. 
26]. 

The  FMC  vehicle  control  software  consists  of  five  major  interconnected 
subsystems  that  are  called  Planner,  Observer,  Mapmaker,  Pilot,  and  Vehicle 
Control  [Ref.  26].  Each  of  these  subsystems  has  a  well-defined  and  important 
function  to  perform.  Together  they  make  the  FMC  model  one  of  the  most 
advanced  and  successful  autonomous  land  vehicles. 
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The  FMC  autonomous  vehicle  world  is  represented  by  digitized  maps. 
These  maps  have  terrain  elevation  and  feature  information  that  is  used  by  the 
Planner.  The  primary  role  of  the  Planner  is  to  generate  segmented  "freeways" 
defining  free  space  from  the  starting  position  to  the  destination  [Ref.  27].  The 
Planner  is  also  capable  of  accepting  mission  requirements  to  decide  the  global 
path.  Such  requirements  may  include  minimizing  detection  of  the  vehicle  by  the 
enemy.  Another  possibility  is  to  minimize  the  time  or  energy  involved  to 
accomplish  the  mission. 

The  segmented  freeway  is  used  by  the  Observer.  The  Observer  makes  use 
of  various  sensors  sucn  as  a  sonic  imaging  sensor  for  obstacle  detection  and  an 
inertial  land-navigation  system  for  calculating  position  and  heading.  With  the 
input  from  the  Planner  and  data  from  the  sensors,  the  Observer  derives  a  more 
usable  plan  for  the  next  subsystem,  the  Mapmaker. 

The  Mapmaker  generates  the  Pilot  Map  containing  the  vertices  of  a 
polygonal  representation  of  the  global  path  border,  nearest  obstacle  borders,  and 
sensor  visibility  limits.  This  is  achieved  by  combining  the  Observer’s  input  with 
the  Obstacle  Map.  The  latter  is  the  product  of  the  sonic  imaging  sensor. 

The  Pilot  Map  is  very  detailed  but  also  very  localized.  It  is  used  by  the 
Pilot  whose  main  responsibility  is  to  guide  the  vehicle  along  an  optimum  path 
that  is  determined  dynamically.  To  determine  the  optimum  path,  the  Pilot 
generates  several  subpaths  that  are  weighted  according  to  certain  criteria.  Once 
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the  optimal  path  is  picked,  the  Pilot  issues  the  necessary  instructions  to  the  final 
subsystem,  the  Vehicle  Controller,  for  actual  execution. 

A  substantial  amount  of  effort  has  been  placed  on  the  problem  of  obstacle 
avoidance  in  the  FMC  program.  When  an  obstacle  is  encountered,  the  Pilot 
switches  modes.  It  stops  goai-seeking  and  starts  obstacle-following.  When  the 
vehicie  overcomes  the  obstacle,  it  resumes  its  goai-seeking  mode. 

2.  Hughes  Research  Laboratory  Autonomous  Vehicle  (1983) 

The  Hughes  Research  Laboratory  autonomous  vehicie  is  another  state-of- 
the-art  autonomous  system.  Like  the  FMC  modei.  it  too  has  a  modei  of  the  world 
in  which  the  autonomous  vehicie  is  going  to  operate.  Mission  requirements  and 
constraints  are  also  accepted  by  the  modei  to  derive  a  plan  for  accomplishing  the 
mission.  Various  sensors  provide  the  required  information  about  the  environment 
for  the  vehicle  to  adapt  dynamically  to  unforeseeable  situations. 

The  entire  system  architecture  of  the  Hughes  system  is  based  on  a 
situation  assessment  module  and  an  action  planning  module  [Ref.  28].  The 
former  uses  available  knowledge  about  the  behavior  and  characteristics  of  a  given 
object.  Together  with  the  interrelation  between  the  various  objects,  it  tries  to 
visualize  the  surrounding  environment.  The  latter  module  does  the  actual 
formulation  of  various  actions  required  to  fulfill  the  mission. 

The  most  notable  difference  of  this  autonomous  vehicle  from  other 
autonomous  vehicle  projects  is  the  method  of  knowledge  representation  and  the 
emphasis  on  applying  artificial  intelligence  techniques.  The  system  uses  three 
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types  of  stereotyped  knowledge  representations  called  special  problem  solvers, 
scripts  and  domain- specific  production  rules  [Ref.  28]. 

The  special  problem  solver  consists  of  four  path  experts  that  decide  which 
path  to  follow.  The  script  based  problem  solver  is  used  to  provide  predetermined 
("canned")  plans  to  solve  problems  that  have  stereotyped  behavior.  The  rule- 
based  system  takes  over  whenever  the  script  system  cannot  produce  the  proper 
actions  to  handle  a  situation. 

The  four  path  experts  are  called  Shortest-path.  Hide.  Feasible-path,  and 
Lost-path.  Each  is  designed  to  cater  to  the  requirements  of  an  autonomous 
vehicle  in  various  situations.  The  Shortest-path  expert  generates  the  shortest 
path  between  two  points  taking  into  account  the  obstacles  between  the  two 
locations.  The  Hide  expert  determines  a  path  with  the  best  concealment 
characteristics.  This  path  minimizes  the  vehicle's  exposure  to  threats.  The 
Feasible-path  expert  uses  heuristics  to  produce  a  path  between  two  locations. 
The  heuristic  procedure  of  this  expert  uses  the  information  the  vehicle  has 
gathered  along  the  path  and  the  information  about  it’s  current  environment  to 
decide  a  feasible  path  for  the  vehicle  to  follow.  Finally,  the  Lost-path  module 
generates  a  path  for  the  vehicle  to  explore  and  wander  around  the  area  when  it 
has  no  path  to  the  designated  goal. 

The  hardware  for  the  Hughes  system  includes  a  DEC  20  computer  that 
implements  a  rule-based  system  for  deciding  the  proper  action  for  the  vehicle  to 
follow.  Several  Z80  computers  are  used  to  solve  individual  specialized  problems 
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such  as  finding  the  optimal  path.  Another  processor  generates  commands  to  the 
vehicle  control  computer.  Vision  is  handled  by  an  image  processing  computer.  A 
Lisp  machine  is  used  for  for  vehicle  control.  The  vehicle  carries  a  vidicon  camera, 
ultrasonic  sensors,  touch  sensors,  and  infrared  ranging  sensors. 

3.  Martin  Marietta  Autonomous  Land  Vehicle  (1986) 

The  aim  of  this  project  is  to  demonstrate  the  state  of  the  art  in 
autonomous  navigation  and  tactical  decision  making  (Refs.  29.30].  The  vehicle 
used,  called  the  ALV  (Autonomous  Land  Vehiciej.  is  an  eight-wheeled  ail-terrain 
vehicle  from  Standard  Manufacturing,  Inc.  It  is  capable  of  traveling  up  to  18 
mph  on  rough  terrain  and  up  to  45  mph  on  improved  surfaces. 

Mission  goals  and  constraints  specified  to  the  ALV  are  interpreted  by  a 
Reasoning  Subsystem.  The  output  from  the  Reasoning  Subsystem  is  a  set  of 
subgoals  to  be  fulfilled  in  order  to  accomplish  the  mission.  The  Perception 
Subsystem  controls  all  the  sensors  and  generates  a  symbolic  model  of  the 
environment  for  reasoning.  The  model  consists  of  road  boundaries.  Moving  the 
vehicle  along  the  specified  trajectory  is  handled  by  the  Control  Subsystem. 

The  Perception  Subsystem  sensors  consist  of  an  RCA  color  video  CCD 
camera  and  a  laser  range  scanner.  The  image  taken  by  the  camera  is  processed  by 
a  VICOM  image  processor.  The  output  from  this  image  is  a  set  of  2-D  edge 
points  representing  the  two  road  boundaries.  To  generate  a  3-D  scene  model  for 
the  Reasoning  Subsystem,  range  information  from  the  laser  scanner  is  used  by  the 
image  processor  to  compute  the  road  boundaries  in  3-D  vehicle  coordinates. 
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The  Reasoning  Subsystem  consists  of  a  goal  seeker,  a  navigator,  and  a 
knowledge  base.  The  goal  seeker  analyzes  the  mission  given,  and  using  the 
information  in  the  knowledge  base  derives  a  sequence  of  activities  for  the  vehicle 
to  execute  to  achieve  the  goal.  The  navigator  uses  the  3-D  model  from  the 
Perception  Subsystem  to  compute  several  possible  trajectories,  and  uses  two  cost 
functions  to  determine  the  trajectory  for  the  vehicle  to  follow. 

The  pilot,  which  is  part  of  the  Control  Subsystem,  takes  the  specified 
trajectory  the  vehicle  should  follow  and  converts  it  into  a  sequence  of  steering 
commands  to  drive  the  vehicle. 

The  hardware  architecture  used  in  the  ALV  consists  of  an  Intel 
multiprocessor  system  that  has  an  80286/80287  master  processor,  an  80816 
navigation  processor,  an  8086  vehicle  control  processor,  and  an  8089  multichannel 
controller.  The  Perception  Subsystem  is  managed  by  the  VICOM  image 
processor.  However,  this  architecture  will  be  affected  by  plans  to  use  a  more 
advanced  computer,  the  BBN  Butterfly  parallel  computer,  to  manage  the 
increasing  complexity  of  the  Reasoning  Subsystem.  Another  plan  is  to  replace  the 
currently  heavily  loaded  VICOM  image  processor  with  a  CMU  WARP  computer 
[Ref.  29]. 

D.  SUMMARY  AND  CONCLUSIONS 

In  the  control  of  autonomous  land  vehicles,  the  need  for  several  high- 
performance  and  specialized  processing  systems  working  in  parallel  is  fairly 
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obvious.  Without  such  elaborate  hardware,  software,  and  advanced  computer 
architectures,  an  autonomous  vehicle  will  not  be  able  to  fulfill  even  its  most  basic 
requirement,  namely,  to  adapt  quickly  to  environmental  changes. 

Many  varieties  of  sensors,  each  capable  of  providing  the  vehicle  with  a  means 
to  sense  the  environment  in  a  different  manners  are  extremely  important.  An 
autonomous  vehicle's  ability  to  dynamically  modify  its  behavior  depends  on  the 
range  and  the  capability  of  the  various  sensors  installed  in  the  vehicle.  Without 
these  sensors,  autonomy  would  be  very  difficult  to  achieve  if  not  impossible. 

The  effect  of  various  gam  settings  in  the  vehicle  controller  could  have  a 
significant  impact  on  the  performance  of  an  autonomous  vehicle.  With  an 
improper  gain,  it  was  found  in  the  FMC  model  that  the  vehicle  fails  to  behave 
properly  or  performs  poorly  [Ref  26j. 

In  order  to  avoid  the  problem  of  improper  gain  settings,  a  computer 
simulation  allows  the  various  vehicle  controller  gains  to  be  adjusted  easily.  With 
this  facility,  different  types  of  vehicle  behavior  can  be  simulated.  The  effect  of 
these  gain  settings  can  be  realistically  visualized  by  means  of  the  3-D  graphics 
simulation  model. 
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III.  DETAILED  PROBLEM  STATEMENT 


A.  INTRODUCTION 

In  this  chapter,  the  mode!  used  for  the  3D  graphics  simulation  is  described  in 
detail.  To  assist  a  reader  who  has  no  control  theory  background,  a  brief 
description  of  the  purpose  of  developing  a  mathematical  model  and  its  subsequent 
linearization  is  given. 

The  aim  of  this  research  is  stated  in  the  following  section.  This  serves  as  a 
motivation  for  developing  the  graphics  simuiation.  The  reader  should  bear  in 
mind  that  the  hypothesis  used  in  'his  research  has  not  and  may  not  be  proven 

theoretically  correct.  The  answer  to  this  question  requires  much  more  work 
beyond  what  is  presented  in  this  work. 

Many  important  interactions  between  the  vehicle  and  the  environment  when 
the  vehicle  is  moving  have  been  neglected  to  keep  the  complexity  of  the 
mathematical  model  manageable.  However,  a  short  discussion  of  some  of  these 
interactions  is  included  to  give  the  reader  a  better  appreciation  of  the  real 
complexity  involved. 

The  last  section  in  this  chapter  provides  a  detailed  derivation  of  the 
mathematical  model  used.  All  of  the  model  linearization  analysis  is  also 
presented. 
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B.  AIM 


The  aim  of  this  work  is  to  examine  and  study  by  way  of  an  "out  of  the 
vehicle  windshield"  graphics  simulation  model,  a  new  technique  for  autonomous 
vehicle  steering  control.  This  technique  attempts  to  mimic  the  way  a  human 
navigates  his  vehicle  on  the  road. 

The  hypothesis  is  that  a  human  driver  unconsciously  divides  his  route  to  his 
destination  into  "chunks"  of  small  interconnecting  line-of-sight  segments.  These 
segments  are  not  prepared  a  priori,  but.  instead  are  built  dynamically  while 
driving  along  a  road.  It  is  assumed  that  unconscious  planning  determines  the 
distance  of  the  next  road  segment  from  the  current  vehicie  position.  A  point  at 
the  end  of  this  road  segment  is  then  the  driver's  unconscious  subgoal. 

The  location  of  a  subgoal  on  the  road  depends  on  several  factors  such  as  the 
speed  at  which  the  vehicle  is  traveling,  the  road  surface  condition,  the  level  of 
driving  experience  of  the  driver,  and  the  general  nature  of  the  surrounding 
environment.  The  environment  refers  to  situations  such  as  the  traffic  conditions 
in  front  or  behind  the  vehicle,  the  number  of  lanes  available,  and  any  potential 
danger  spots  ahead  such  as  intersections,  road  bends,  etc. 

This  work  assumes  that  near-perfect  vision  is  available  for  the  autonomous 
vehicle  and  that  the  road  is  obstacle-free.  These  seeming  /  unreasonable 
assumptions  were  made  to  allow  the  author  to  concentrate  on  the  aspect  of 
unconscious  driving  rather  than  on  the  problems  of  image  and  vision  processing, 
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and  obstacle  avoidance,  where  there  are  currently  numerous  research  activities 
being  carried  out  by  others  [Refs.  14-19]. 

C.  STATE  SPACE  REPRESENTATION 

The  aim  of  studying  dynamic  system  behavior  is  generally  one  of  gaining  an 
understanding  of  the  system,  with  a  view  to  controlling  it  to  satisfy  a  required 
specification  [Ref  31].  A  block  diagram  can  be  used  to  pictorially  represent  the 
system  to  be  controlled.  But  to  perform  any  analysis,  a  quantitative  description  is 
required  and  this  may  not  be  available  from  a  block  diagram.  A  system  can  be 
described  quantitatively  using  a  set  of  mathematical  expressions  which  is 
commonly  known  as  the  mathematical  mode!  of  the  system.  The  two  common 
methods  to  describe  a  system  quantitatively  are  the  transfer  junction  method  and 
the  state  space  method  [Ref.  31].  The  latter  technique  is  adopted  in  this  work 
because  it  is  more  appropriate  for  computer  simulation  and  it  is  also  able  to  cope 
with  more  complex  systems  including  nonlinear  effects. 

Most  systems  are  inherently  non-linear  in  nature.  However,  in  many  cases,  a 
linearized  analysis  can  be  performed  to  predict  the  system  behavior  and  to  obtain 
suitable  gain  values  for  the  actual  model.  Linearization  basically  involves 
restricting  the  values  of  the  system  variables  to  sufficiently  small  deviations  from 
a  datum  point;  i.e.,  the  normal  operating  point  of  the  system.  A  linearized 
system  analysis  of  the  vehicle  steering  problem  is  included  in  this  chapter. 
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D.  VEHICLE  MECHANICS 


1.  Motivation 

There  are  many  complex  interactions  occurring  between  a  moving  vehicle 
and  the  environment  that  are  ignored  in  this  simulation.  Some  of  these 
interactions  are  discussed  here  to  provide  the  reader  with  some  insight  into  the 
complexity  involved. 

2.  Resistance  to  Motion 

Vehicle  acceleration  arises  when  there  is  tractive  effort  between  the  tires 
and  the  road  [Ref  32! .  However,  not  all  the  tractive  effort  is  used  to  provide 
acceleration:  rather,  a  certain  proportion  of  this  effort  is  needed  to  overcome 
resistance  to  motion.  The  main  sources  of  resistance  to  motion  are  air  resistance, 
rolling  resistance,  and  gradient  resistance. 

The  amount  of  air  resistance  depends  on  numerous  factors.  The  vehicle 
shape,  size  and  its  velocity  are  some  of  these  factors.  The  interaction  of  the  tires 
and  the  road  surface  give  rise  to  rolling  resistance  which  depends  upon  factors 
such  as  vehicle  velocity,  vehicle  load,  and  the  type  of  road  surface.  Gradient 
resistance  arises  only  when  the  vehicle  climbs  a  slope.  The  amount  of  gradient 
resistance  is  directly  proportional  to  the  steepness  or  gradient  of  the  slope  it  is 
overcoming. 

3.  Slip  Angle 

When  a  wheel  is  rolling,  it  is  acted  upon  by  a  side  force  due  to  imperfect 
contact  between  the  tires  and  the  road  surface.  The  angular  difference  between 
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the  direction  of  motion  and  true  wheel  rolling  direction  is  called  the  slip  angle 
[Ref.  33].  When  a  vehicle  is  cornering,  depending  on  the  sign  of  the  slip  angle, 
the  vehicle  may  understeer  or  oversteer. 

4.  Brakes 

The  amount  of  braking  effort  required  is  related  to  the  load  carried  by  the 
wheels  and  the  coefficient  of  friction  of  the  road  surface.  Another  important 
consideration  is  the  location  of  brakes.  When  brakes  are  applied  while  a  vehicle  is 
cornering,  computation  of  the  braking  effort  is  more  complex.  This  is  due  to  the 
side  forces  acting  on  the  wheels  when  the  vehicle  is  cornering. 

E.  VISION  MODEL 

The  vision  model  used  in  this  graphics  simulation  is  extremely  simple.  The 
model  consists  of  a  set  of  road  points  representing  the  center  of  the  entire  road 
circuit.  When  the  vehicle  is  operating  in  the  autopilot  mode,  it  "sees"  these 
points  down  the  road,  one  of  which  is  selected  to  be  the  new  target  point  for  the 
vehicle  to  steer  towards. 

F.  SIMULATION  MATHEM  ..TICAL  MODEL 

1.  A  Simplified  Planar  Dynamic  Model  For  Manual  Control 

The  notation  used  in  this  work  will  follow  as  closely  as  possible  to  that 
adopted  by  Frank  and  McGhee  [Ref.  34].  A  top  view  of  the  vehicle  is  shown  in 
Figure  3.1. 
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Figure  3.1  Top  View  Of  The  Vehicle 
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The  vehicle  will  be  confined  to  a  flat  road  surface.  Therefore  z  =  0 ,  z  = 
0,  and  the  position  vector  can  be  collapsed  to  a  two-dimensional  vector.  The 
rotational  moment  of  inertia  is  ignored.  This  means  that  the  vehicle  is  idealized 
to  a  point  mass.  To  further  simplify  the  model,  it  is  assumed  that  the  velocity 
vector  always  lies  along  the  vehicle  x  axis:  i.e.,  no  sideslip  angle  is  allowed. 
Finally,  it  is  assumed  that  the  vehicle  turning  rate.  w.  is  linearly  proportional  to 
the  forward  velocity  and  to  the  steering  wheel  angle,  6.  That  is. 


vj  -  k  9x 


(3.1) 


To  calculate  the  associated  turning  radius.  R.  note  that  "he  time  to  rotate  the 


venicie  through  an  angle  2rr  is 


2~  2  r 

hn  =  -  ■  = 


A  kj\  6i\ 


(3.2) 


while  the  distance  traveled  in  this  time  is 


d  =  27 tR  -  I  x\  t 


2  IT 


(3.3) 


Thus 


R  = 


27T 


*y!  >i\  ki\  »l 


(3.4) 


Or 


k‘,  = 


*  R\0\ 


(3.5) 


33 


This  equation  shows  that  large  values  for  k ^  correspond  to  "stiff”  steering  while 
small  values  correspond  to  "sloppy"  steering. 


Longitudinal  control  modeling  accelerator  control  (Refs.  35.36]  can  be 
approximated  by 


( f> 


6) 


w’here  xc  is  the  command  velocity,  which  in  turn  is  a  function  of  the  accelerator 
depression  angle,  and  ra  is  the  acceleration  time  constant.  It  is  easily  shown  that 
for  a  step  change  in  x,  at  t  =  f0  .  the  resulting  velocity  profile  is 

t  —  t  o 

x{t)  =  x(t0 )  -  (ie(i)  -  x(t0))e  '• 

Combining  all  of  the  above  results,  a  suitable  state  vector  for  this  system 
is 

X  =  ( XE ,  yE,  i,  0)T  (3.8) 


If  the  control  vector  ,  provided  by  the  human  operator  is  defined  as 

u  =  (ic,0)T  (3.9) 

then,  from  the  above  analysis,  the  component  form  of  the  state  equation  is: 

i(l)  =  xE  =  x  cos  rp  =  x(3)  cos  z(4)  (3.10) 

x( 2)  =  yE  =  x  sin  xb  =  x(3)  sin  x(4)  (3-11) 
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x(3)  -  x  = - —  x(3)  4 — —  u(l) 

^  a  '  a 

(3.12) 

i(4)  =  0  =  z(3)  u( 2) 

(3.13) 

For  manual  control.  u(t)  is  provided  by  the  human  operator.  Eq.  (3.10  - 
3.13)  can  then  be  numerically  integrated  and  provided  to  the  operator  in  the  form 
of  a  graphics  display  to  permit  him  to  guide  the  vehicle  around  a  prescribed 
course.  Note  that  for  practical  vehicles,  both  xc  and  0  must  have  upper  and  lower 
bounds. 

2.  Pursuit  Navigation  and  Small  Angie  Linearization  Analysis 
From  the  previous  analysis,  we  have 


~  -  (~£-  Ve-  x-  T 

O  -T  — 

iu.1 O | 

•  m  9  %  m  •  rp 

X  =  ( XE ,  yE ,  X,  0 ) 

(3.16) 

For  autopilot  control,  in  the  research  of  this  study,  the  vehicle  forward  velocity  is 
assumed  to  be  constant.  Therefore 

i(3)  =  0  (3.17) 

One  approach  to  steering  the  vehicle  is  to  simply  aim  it  directly  at  the 
current  steering  point.  That  is,  the  vehicle  heading  could  in  principle  be  governed 
by  the  simple  relationship 

0(0  =  v{t)  (3.18) 

Such  a  steering  law  is  sometimes  called  pure  pursuit  navigation.  Obviously,  if 
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pure  pursuit  navigation  could  be  realized,  the  vehicle  would  pass  directly  through 
each  steering  point.  However,  this  does  not  fit  the  model  of  this  chapter  in  which 
the  steering  point  is  at  a  constant  distance  d  ahead  of  the  vehicle.  A  potential 
solution  to  this  problem  is  to  differentiate  Eq.  (3.18)  to  obtain 

i>{t)  =  <r(t)  ,'3. 19) 

Unfortunately,  referring  to  Figure  3.1.  it  can  be  seen  that  whenever  iv  =  0,  it  will 
also  be  true  that  a  -  0.  In  this  case,  the  vehicle  will  simpiy  move  parallel  to  the 
road  center  ana  will  nor  turn  toward  it.  To  remedy  this  problem,  an  integral 
term  can  be  added  to  Eq.  (3.19)  resuiting  in  the  steering  equation 

v  =  a  -  ka  [a  —  ib  )  .  kj.  ■  0  (3.20) 


Referring  to  Figure  3.1,  the  "line-of-sight"  angle,  o.  is  given 


mathematically  by 


o  =  tan 


-l 


Yt  -  Ye  X 

xT  -  XE 


(3.21) 


The  corresponding  line-of-sight  rate,  cr,  can  be  approximated  by 


tj  -  tj_ j 

where  j  is  an  index  associated  with  successive  computation  cycles, 
be  used  in  the  following  linearized  system  analysis. 


(3.22) 
Eq.  (3.20)  will 
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Referring  again  to  Figure  3.1,  for  the  straight  road  case,  and  using  small 


angle  approximations,  we  have  the  following: 


d  »  yE 


(3.23) 


o  = 


VE 


(3.24) 


o  = 


y_E 

d 


(3.25) 


V)  - 


Ve 

m 


(3.26  i 


ID  - 


n 

i(0) 


i  ^.2. 


Using  Eq.  (3.24)  -  (3.27),  the  vehicle  guidance  law  can  be  written  as 


VE  . 

%'  = - —  +  k0 

d 


Ve  Ve 

d  i(0) 


(3.28) 


From  Eq.  (3.13) 


^  x(3)  u(2) 


(3.29) 


Therefore  the  vehicle  guidance  law  can  also  be  written  as 


u(2)  « 


z(3) 


*(3) 


1_ 

d 


m  ] 


Ve 


Ve 


(3.30) 
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From  Eq.  (3.27)  and  (3.28).  the  linearized  vehicle  control  equation  is 


VE 


Ve 

d 


-  k. 


Ve  Ve 


(331) 


or 


'Je  ~  ~  HUE 


'’v  'Je  ;  na  He 
u 


As  stated  previously,  for  the  purpose  of  linearized  system  analysis,  it  is  assumed 
that  the  vehicle  steers  toward  a  point  located  in  front  of  the  vehicle  at  a  constant 
distance  d  where 


d  = 


'~r> 

1 


(  *>  oo 
1  0.00 


) 


The  quantity  T  is  called  the  steering  point  prediction  :ime  and  is  evidently  given 
by 


x 


Using  Eq.  (3.33),  Eq.  (3.32)  can  be  re-written  as 


VE  ~  - 


(3.34) 


(3.35) 


or 


Ve  + 


K 

Ve  +  -jtVe  ~  0 


(3.36) 
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(3.37) 


The  characteristic  equation  [Ref.  37]  associated  with  Eq.  (3.36)  is 
A2  +  fcj  A  +  &q  =  0 
where 


*i  = 


(3.38) 


and 


k 


o  - 


i 


(3.39) 


The  corresponding  response  of  me  system  to  initial  condition  errors  is.  for  the  case 
of  distinct  eigenvalues. 


y(0 


Aii1  A 

C^t  - 


(3.40) 


where  Aj  and  A2  are  the  roots  of  Eq.  (3.37),  Cj  and  c2  are  determined  from  the 
boundary  conditions  t/(f0),  y(f0),  and  t0  is  the  time  when  autopilot  is  turned  on. 

Critical  damping  [Ref.  38]  results  when  the  eigenvalues  \l  and  A2  are 
equal,  real,  and  negative.  Critical  damping  implies  the  most  rapid  response 
possible  to  steering  errors  without  overshooting  the  road  center  line  in  response  to 
an  initial  position  error.  From  Eq.  (3.37).  the  system  eigenvalues  are 


k\ 

A  - - -  ± 

'*!  1 

2 

c 

-V 

1 

2 

i  2  - 

(3.41) 
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Since  critical  damping  results  when  the  second  term  in  this  equation  is  zero,  it 


follows  that 


Substituting  Eq.  (3.38)  and  Eq.  (3.39)  into  Eq.  (3.42). 


Solving  this  equation  yields  'he  following  relationship: 


(3.42) 


(3.43) 


k'T  = 


( o  i 


.44  I 


Using  this  relationship  in  Eq.  3.41). 


A  =  —  k„ 


>.45  j 


From  this,  the  system  total  time  constant,  Ttolal ,  [Ref.  38]  is  given  by 


Tlotal 


A, 


A, 


_2_ 

k„ 


(3.46) 


which  means  that  vehicle  position  error  will  be  corrected  to  about  40%  of  its 
initial  value  in  approximately  Ttotai  seconds  [Ref.  39].  As  a  specific  example,  if 
T  -  1  is  chosen,  then  k^  =  1,  A  =  —  1,  and  Ttolai  =  2.  Another  example,  if  T  =  2 
is  chosen,  then  ka  =  0.5.  A  =  —0.5,  and  Tlotal  =  4.  This  completes  the  derivation 
of  parameter  values  for  this  example  of  a  vehicle  steering  equation. 
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3.  Proportional  Navigation  With  Integral  Term 

In  Chapter  V.  it  is  shown  that  while  pursuit  navigation  performs  as 
predicted  by  the  above  linearization  for  driving  on  a  straight  road,  it  tends  to 
steer  to  the  inside  of  turns  on  a  curved  roadway.  One  way  to  solve  this  problem 
is  to  introduce  an  additional  gain  term.  k-.  which  multiplies  a.  This  result  is  a 

°  <7 

form  of  proportional  navigation  [Ref.  40l  with  the  addition  of  the  integral  term 
introduced  in  the  previous  section  of  this  chapter. 

In  order  to  determine  a  value  tor  k  suitable  for  driving  on  a  curved  road, 
it  should  be  noted  that  'he  resulting  vehicle  guidance  law  is: 

V  =  kao  -  ka{o—u>)  (3.47) 

and  that  the  condition  for  steady  turn  is  w>  =  a.  Thus,  in  such  a  situation. 

a  =  =  kao  +  ka(a-%l>)  (3.48) 

so 

1-k- 

o— ip  =  — - — a  (3.49) 

ka 

From  Figure  3.1,  the  road/vehicle  equation  for  a  curved  road  is 

XE2  +  [\)e  -  R)2  ~  (3.50) 

or 

xe2  +  Ve2  ~  2y^ R  =  0  (3.51) 
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which  can  be  approximated  by 


xe'  =  2Ver 


(3.52) 


Using  small  angle  approximations, 


XE  ~ 


iT 


(3.53) 


and  thus,  on  a  curved  road  with  raaius  R. 


VE  = 


(3.54) 


The  value  for  a  is  tnus  approximately 


a 


>j£  tr 


3.55) 


and  to  stay  on  the  road. 


t/>  =  -§  (356) 

Since,  in  a  steady  turn,  a  =  p,  combining  Eq.  (3.49),  (3.55),  and  (3.56)  it  follows 
that 


x  T  1  ka  x 
2  ~R  ~  ka  ~R 


(3.57) 


or 


T  =  2 


1~ki 

K 


(3.58) 


Eq.  (3.58)  is  one  of  the  constraints  for  this  model. 
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4.  Linearized  Analysis  For  Proportional  Navigation 


Using  small  angle  approximations,  with  the  inclusion  of  kg  and  the  road 
curvature,  Eq.  (3.36)  becomes 


VE 


x 


-  k. 


UT  ~  Ve 
xT 


(3.59) 


or 


VE 


The  characteristic  equation  associated  with  this  result  is 

/\  |  "  kt^  —  0 


where 


Substituting  constraint  Eq.  (3.58),  it  follows  that 


(3.60) 


1.61 ; 


(3.62) 


(3.63) 


ki 


kiK 

2(1  -  *;) 


(3.64) 


=  k. 


2(1  ~  K)  +  kj 

2(1  -  y 


(3.65) 


43 


(3.66) 


=  ka 


\ 


and 


A-0  - 


(3.67) 


Referring  to  Ea.  (3.61) 


A  - 


o 


l 


i 


- 

^  _  u 

7.  *  A(/  _  r_ 

2  -  *■ 

_ *  1 

i 

^  4  -  4k  ~  ° 

<7 

4  -  4  k7 

1 

\  1 

L— 

(3.681 


3.69) 


=  -  K 


_j. _ 

4-4*. 


(3.70) 


ko 


4  -  4k- 

a 


Thus,  for  the  critical  damping  condition, 
k ?  +  4k-  —4  =  0 

a  a 


(3.71) 


(3.72) 
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or 


k- 


a 


=  -  2  = 


(3.73) 


Solving  Eq.  (3.73)  with  the  constraint  k °  >  0, 


k  =  0.82S 

(T 


From  Eq.  (3.71) 


so  from  Eq.  (3.74) 


A  =  - 


1.172 

0.688 


=  -  i.ro: 


kr 


5.74 


(3.75) 


(3.76) 


and  from  Eq.  (3.58) 


0.344  1 

________  ^ 

ka  3  kff 


(3.77) 


or 


kaT 


1 

3 


(3.78) 


As  an  example  of  the  application  of  the  above  results,  if  A  =  —  0.5  is  chosen,  then 
k0  =  0.294,  T  =  1.17,  k ^  =  0.828.  and  rtoia[  =  4.  For  another  example,  if  T  =  0.8 
is  chosen,  then  ka  =  0.43.  A  =  -  0.73,  k ^  =  0.828.  and  Ttotal  =  2.7. 
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G.  SUMMARY 


The  aim  of  this  study  is  established.  The  assumptions  made  have  been 
delineated  so  that  a  mathematical  model  can  be  developed  for  the  realization  of  a 
computer  simulation  to  study  both  manual  and  automatic  steering  of  a  highway 
vehicle. 

In  the  next  chapter,  the  main  concern  is  the  actual  implementation  of  the  3D 
graphics  simulation  using  the  mathematical  model  derived  in  this  chapter. 
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IV.  COMPUTER  SIMULATION  MODEL 


A.  INTRODUCTION 

Various  methods  of  implementing  the  mathematical  mode!  developed  in  the 
previous  chapter  were  examined  during  the  formulation  of  this  study.  It  was 
finally  decided  that  the  best  way  to  perform  the  simulation  would  be  to  have  a  3D 
color  graphics  animation  model  which  can  be  driven  by  the  user.  One  of  the  most 
suitable  machines  available  at  'he  Naval  Postgraduate  School  for  this  purpose  is 
the  IRIS  (Integrated  Raster  Imaging  System!  coior  graphics  system.  A  brief 
description  of  'his  graonics  system  configuration  and  its  hardware  features  is 
given  in  this  chapter. 

In  what  follows,  much  attention  is  devoted  to  the  man-machine  interface  of 
the  simulation.  The  user  can  drive  the  simulation  with  a  mouse  attached  to  the 
graphics  system.  He  can  also  use  the  keyboard  to  turn  on  or  off  certain 
information  displays  concerning  the  status  of  the  simulation. 

A  complete  description  of  all  the  modules  and  supporting  files  which  are  used 
for  the  simulation  is  provided  in  this  chapter  for  those  who  plan  to  study  the 
simulation  in  detail.  A  user  guide  is  also  included,  though  it  is  not  absolutely 
necessary  to  read  it  wholly  in  order  to  run  the  simulation. 
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B.  IRIS-2400  WORKSTATION 


1.  Hardware  And  Overall  System  Description 

The  IRIS  graphics  workstation  installed  in  the  Naval  Postgraduate  School 
Graphics  Laboratory  is  a  high-performance,  high-resolution  1024  x  768  color 
graphics  system.  A  combination  of  custom  VLSI  circuits,  conventional  hardware, 
iirmware.  ana  software  proviae  a  very  poweriui  set  ot  graphics  commands  to 
perform  2D  and  3D  graphics  LRefs.  41-441.  There  are  currently  two  IRIS  systems 
installed  in  *he  laboratory.  Both  systems  are  Unix-based  machine  but  one  system 
nas  a  Motorola  MC68010  processor  with  5MB  of  CPU  memory  while  tne  other 
system  has  a  Motorola  MC68020  processor  with  6MB  of  CPU  memory.  The 
configuration  of  both  IRIS-2400  workstations  consist  of  an  electronic  cabinet  with 
two  72  MB  Winchester  disk  drives,  an  83-key  up-down  encoded  keyboard,  a 
three-button  mouse,  a  high-resolution  60  Hz  non-interlaced  19-inch  RGB  color 
monitor,  32  bitplanes,  a  hardware  matrix  multiplier  Geometry  Pipeline,  and  a 
floating  point  accelerator. 

The  IRIS  hardware  consists  of  three  pipelined  components.  It  is  this 
design  structure  that  makes  the  IRIS  different  from  many  other  graphics  systems. 
Many  systems  tend  to  implement  their  graphics  capabilities  with  software  that  is 
cheaper.  However,  these  systems  have  much  lower  efficiency  and  much  lower 
performance.  Also  with  these  systems,  the  3D  color  graphics  simulation  model 
would  require  significantly  more  programming  effort  and  time,  not  considering  the 
fact  that  the  final  overall  performance  may  not  be  suitable  for  this  simulation. 
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The  three  pipelined  components  in  the  IRIS  system  are  the  applications/graphics 
processor,  the  Geometry  Pipeline,  and  the  raster  subsystem  [Ref.  4 1] . 

Graphics  commands  are  processed  by  the  applications/graphics  processor. 
Commands  are  first  sent  through  the  Geometry  Pipeline,  which  performs  matrix 
transformations  on  the  coordinates,  dips  the  coordinates  to  normalized 
coordinates,  and  scales  the  cranstormed.  clipped  coordinates  to  screen  coordinates. 
The  raster  subsystem  accepts  the  output  of  the  Geometry  Pipeline.  It  fills  in  the 
pixels  between  the  endpoints  of  the  lines,  tills  in  the  interiors  of  polygons,  converts 
character  codes  into  bit-mapped  characters,  and  performs  shading,  deptn-cueing. 
and  hidden  surface  removal.  The  system  maintains  a  color  value  for  each  pixel  in 
its  bitplanes  which  determines  the  image  coior  on  the  monitor.  A  total  of  thirty- 
two  bitpianes  allow  color  graphics  images  to  be  presented  in  a  very  realistic  way. 

2.  Programming  Language 

The  IRIS  system  software  is  written  in  C.  but  the  commands  in  the 
graphics  Library  are  callable  in  C,  FORTRAN.  Pascal,  and  Extended  Common 
Lisp  (ExCL).  However,  at  the  time  when  the  simulation  was  implemented,  only 
Pascal  and  C  were  available.  Consequently,  C  was  chosen  to  be  the  programming 
language  for  implementing  the  simulation.  One  of  the  reasons  for  this  decision 
was  the  programming  experience  of  the  author  with  C  and  the  other  was  to 
maintain  compatibility  with  the  IRIS  system  software.  However,  C  is  not  without 
its  disadvantages.  One  of  problems  with  C  is  that  it  is  a  weakly  typed  language. 
This  tends  to  make  software  development  more  frustrating  and  time  consuming. 
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This  frustration  could  have  been  considerably  alleviated  if  a  strongly  typed 


language  like  Pascal  had  been  used. 

3.  Graphical  Objects 

This  is  a  group  of  drawing  commands  used  to  defined  a  geometric  model 
or  an  object.  The  advantage  of  using  these  commands  is  that  the  graphical 
oojects  can  then  be  treated  as  a  smgie  entity  which  can  be  moved,  scaiea.  rotated, 
or  combined  with  other  graphic  objects  to  form  more  complex  objects. 

4.  Double  Buffering 

The  screen  mage  in  an  IRIS  system  is  stored  in  a  set  of  bitplanes.  Each 
bitplane  provides  one  bit  of  storage  per  pixel.  An  RGB  value  is  associated  with 
each  pixel  which  determines  the  color  and  the  brightness  of  the  pixel.  This  value 
is  made  up  of  three  eight-bit  intensity  values  -  one  for  red,  one  for  green,  ana  one 
for  blue. 

The  bitplanes  can  be  used  in  either  of  the  two  modes,  single  buffer  or 
double  buffer.  In  the  single  buffer  mode,  up  to  twelve  bitplanes  can  be  used  to 
handle  the  image  color  and  the  rest  can  be  used  for  z-buffering  ,  a  technique  used 
to  remove  hidden  lines  and  surfaces.  The  problem  with  single  buffering  is  that 
the  image  on  the  screen  is  simultaneously  updated  and  displayed.  This  means 
that  incomplete  or  changing  picture  may  appear  on  the  screen. 

In  double  buffering  mode,  the  bitplanes  are  divided  into  two  portions, 
called  front  and  back  buffers.  The  purpose  of  having  two  buffers  is  to  have  one 
buffer  being  updated  while  another  buffer  is  being  displayed.  The  benefit  of  this 
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arrangement  is  that  a  changing  or  incomplete  image  will  not  appear  on  the  screen. 
This  is  important  in  certain  applications  such  as  motion  animation.  The  3D 
graphics  simulation  uses  the  bitplanes  in  double  buffering  mode. 

5.  Coordinate  Transformation 

In  order  to  manipulate  graphical  objects,  coordinate  transformations  are 
required  [Ref.  41].  When  denning  tne  object,  it  is  convenient  to  cnose  a  point  to 
be  the  object  origin  and  to  then  build  the  object  around  this  selected  reference 
point.  The  space  which  the  object  occupies  is  called  object  svace. 

The  object  space  must  be  transformed  into  woria  space  wuen  a  group  of 
objects  is  to  be  displayed  together.  Since  the  woria  space  can  be  viewed  from 
various  directions  and  orientations,  another  coordinate  system  callea  eye  space  is 
required  to  specify  how  the  world  space  is  to  be  viewed.  Finally,  this  eye  space 
must  be  mapped  into  screen  space  which  is  a  2-D  coordinate  system  for  displaying 
the  objects  on  the  graphics  screen. 

Four  types  of  transformation  commands  are  available  on  the  IRIS  to 
perform  the  various  mappings  described  above: 

o  Modeling  transformation  commands,  such  as  rotate,  translate,  and  scale, 
transform  the  coordinate  system  of  objects. 

o  Viewing  transformation  commands,  such  as  polarview  and  lookat,  place  the 
viewer  and  eye  coordinate  system  in  world  space. 

o  Projection  transformation  commands,  such  as  perspective,  window’,  ortho, 
and  ortho2,  transform  eye  space  to  the  screen  coordinate  system. 
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o  Viewport  transformation  commands,  such  as  viewport  and  scrmask.  define 
the  position  of  the  rectangular  region  on  the  screen  to  be  used  for  displaying 
the  image. 

C.  USER  GUIDE 

To  run  the  graphics  simulation,  just  enter  the  following  command: 

car  st  mu 

It  rakes  a  short  time  for  the  computer  to  read  the  roadmap  into  the  memory. 

The  simulation  begins  with  the  display  as  shown  in  Figure  4.1.  As  can  be 
seen,  the  top  half  of  the  graphics  display  is  an  "out-of-the-winashieid"  view  of  the 
worid  and  the  lower  laif  of  the  display  is  the  vehicle  dashboard  display  area. 

On  the  extreme  left  of  the  dashboard  display  is  some  information  about  how 
to  drive  the  vehicle.  This  display  area  shows  that  pressing  the  three  mouse 
buttons  simultaneously  terminates  the  simulation. 

Pressing  the  right  mouse  button  is  equivalent  to  stepping  on  the  accelerator  of 
a  conventional  vehicle  except  that  every  mouse  click  increases  the  desired  speed 
by  a  fixed  increment  of  four  kilometers  per  hour.  Pressing  the  middle  mouse 
button  is  similar  to  stepping  on  the  brake  of  a  conventional  vehicle  except  that 
every  mouse  click  decreases  the  desired  speed  by  a  fixed  decrement  of  four 
kilometers  per  hour.  Pressing  the  left  mouse  button,  which  is  the  third  and  last 
button,  stops  the  vehicle. 
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Moving  the  mouse  to  the  left  or  to  the  right  corresponds  to  turning  the 
steering  wheel  of  a  vehicle.  The  steering  wheel  turning  rate  is  controlled  by  the 
speed  the  mouse  is  moved  towards  the  left  or  the  right. 

Besides  using  the  mouse  buttons  for  driving  the  vehicle,  the  keyboard  keys  are 
used  to  toggle  various  information  displays  or  to  reset  certain  dashboard  displays. 
Pressing  h  or  H  on  the  kevooard  stops  the  simulation  temporarily  and  the  whole 
dashboard  area  is  used  to  display  additional  information  about  the  various  key 
functions. 

The  fuel  gauge  indicates  the  amount  of  t'uei  left  in  the  vehicle.  When  the  fuel 
runs  out  before  the  whole  circuit  is  completed,  the  simulation  stops  and  a  message 
is  displayed  to  inform  the  driver  of  *ne  condition. 

The  compass  is  located  on  the  top  center  of  the  dashboard  display.  This 
shows  the  vehicle  heading  angle.  Following  this  is  the  steering  wheel  display 
indicating  the  position  of  the  steering  wheel,  the  speedometer  showing  the  current 
velocity  of  the  vehicle,  and  the  odometer  recording  the  total  distance  traveled. 
The  first  three  indicators  are  especially  helpful  for  manual  driving  since  it  allows 
the  driver  to  "feel"  the  situation  and  make  more  appropriate  corrections  if 
necessary.  In  real  driving,  these  indicators  are  not  as  important  because  the 
driver’s  kinesthetic  senses  provide  him  with  information  concerning  the  steering 
wheel  and  the  various  forces  acting  upon  him. 

On  the  extreme  right  of  the  dashboard  display  is  the  warning  panel.  When 
the  vehicle  is  not  moving,  the  brake  light  is  turned  on.  When  the  engine  is 
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warmed  up,  the  temperature  light  shows  yellow  and  when  it  overheats,  the  light 
turns  red.  The  most  important  part  of  the  warning  panel  is  the  danger  light. 
This  area  blinks  when  the  vehicle  moves  too  close  to  the  edge  of  the  road.  An 
alarm  will  also  be  given  if  it  is  switched  on  by  the  user  with  one  of  the  keys  on  the 
keyboard. 

The  iast  area  on  the  dasnboard  display  is  called  the  information  aispiay  area. 
The  main  purpose  of  this  area  is  to  show  some  key  technical  data  used  for  the 
current  simulation  run.  This  area,  bv  default,  is  turned  off  and  it  can  oe  turned 
on  with  a  key  on  the  keyboard. 

A  clock  indicating  the  date  and  time  of  day  is  displayed  on  the  top  left  of  the 
graphics  display.  Again  this  can  be  turned  off  with  a  key.  When  the  vehicle  is 
operating  in  the  autopilot  mode,  a  blinking  indicator  is  displayed  on  the  top 
center  of  the  graphics  display. 

D.  MODULE  DESCRIPTION 
1.  Carsimu.c 

This  is  the  main  module  of  the  entire  graphics  simulation.  It  sets  up  the 
system  by  initializing  all  the  local  and  global  variables  and  the  graphics  facilities. 
After  setting  up,  the  actual  simulation  is  controlled  from  this  module.  Figure 
4. 2-4. 8  show  the  flowcharts  of  this  module. 
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(See  Figure  4.3 
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Figure  4.2  CARSIMU.C  Flowchart 
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Figure  4.3  Main  Simulation  Loop  Flowchart  (Part  1) 
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Figure  4.4  Main  Simulation  Loop  Flowchart  (Part  2) 
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Figure  4.5  Main  Simulation  Loop  Flowchart  (Part  3) 
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Figure  4.6  Main  Simulation  Loop  Flowchart  (Part  4) 
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Figure  4.7  Main  Simulation  Loop  Flowchart  (Part  5) 
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Figure  4.8  Main  Simulation  Loop  Flowchart  (Part  6) 
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2.  Circuit. c 


This  module  has  three  main  functions.  The  first  and  primary  function  is 
to  build  the  road  used  in  the  graphics  simulation.  The  road  is  built  with  four 
straight  segments  of  equal  width  and  length.  These  segments  are  connected 
together  by  three  road  curves  to  form  a  open-ended  rectangular  circuit.  The 
length  and  width  of  the  straight  segments  can  be  varied  individually.  The  radius 
of  the  road  curves  can  also  be  individually  modified. 

The  second  function  of  this  module  is  to  "paint "  all  the  road  marks  on 
the  surface  of  the  road.  There  are  three  types  of  road  marks  -  white  arrows, 
white  strips  and  wording  on  the  road  surface.  The  final  function  is  to  "erect11  ail 
the  signboards  along  the  road. 

3.  Find-subgoai.c 

The  function  of  this  module  is  to  search  for  the  next  subgoal  for  the 
vehicle  to  steer  towards  when  the  vehicle  is  operating  in  the  autopilot  mode.  This 
module  uses  the  road  map  generated  by  the  module  map.c  to  compute  and 
determine  the  next  subgoal. 

Instead  of  searching  for  the  subgoal  only  when  the  vehicle  is  in  the 
autopilot  mode,  the  subgoal  is  constantly  being  computed  and  selected  once  the 
vehicle  starts  moving.  There  are  two  reasons  for  doing  this.  The  first  being  that 
it  provides  a  general  solution  to  ensure  that  the  subgoal  is  always  in  front  of  the 
vehicle.  This  is  done  by  making  sure  that  the  very  first  subgoal  is  chosen  in  front 
of  the  vehicle.  Subsequent  subgoals  are  constantly  recomputed  and  selected  as 
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the  vehicle  moves  so  that  the  subgoal  will  always  remain  in  front  of  the  vehicle. 


This  simple  solution  works  in  the  simulation  model  because  the  vehicle  always 
starts  from  the  same  position  and  heads  in  the  same  direction. 

The  second  reason,  which  is  the  more  important  one,  is  that  of  providing 
a  subgoal  auickiv  when  the  autopilot  is  turned  on.  When  the  subgoal  is  not 
constantly  being  recomputed  and  selected,  then  if  the  autopilot  is  turned  on  for 
the  first  time  very  far  down  the  road,  a  significant  and  noticeable  delay  arises  due 
to  the  need  to  searcn  for  a  subgoal  starting  from  the  beginning  of  the  road. 
Another  situation  where  there  is  such  a  deiay  is  when  the  autopilot  is  turned  on' 
and  on  over  a  long  distance.  In  the  latter  situation,  the  subgoal  has  to  be 
computed  from  the  location  where  the  autopilot  was  last  turned  off. 

4.  Map.c 

This  is  the  only  module  that  works  independently  from  the  rest  of  the 
system.  Its  basic  role  is  to  generate  the  road  map  that  is  used  for  subgoal 
computation  and  selection.  Though  it  works  independently,  it  has  to  be  given  the 
same  road  description  as  that  used  for  building  the  road  in  the  main  simulation 
module. 

There  are  a  number  of  road  parameters  that  can  be  modified.  These  are 
the  road  width,  road  length,  road  curve  radius  and  interval  size.  The  last 
parameter  determines  how  far  apart  road  center  line  points  are  spaced  in  the  list 
of  points  available  for  steering  subgoals.  Evidently,  the  smaller  the  interval  size, 
the  greater  is  the  number  of  points  generated  to  represent  the  road.  For  the 
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results  presented  in  Chapter  V,  the  road  points  available  for  vehicle  steering  are 
stored  with  a  spacing  of  1  meter  between  successive  points.  The  output  of  this 
module  is  a  file  containing  the  map  of  the  entire  road.  This  file  is  called  roadmap. 

5.  Other.c 

There  are  many  routines  in  this  module.  Each  routine  builds  a  graphical 
object  such  as  the  sky.  clouds  and  mountains.  There  are  aiso  a  few  supporting 
routines  which  are  called  by  circuit. c  to  build  tne  road  used  in  the  simulation. 
These  supporting  routines  build  the  road  surface,  curves,  arrows  and  signboards. 

6.  Help.c 

When  the  key  h  or  H  is  pressed,  the  lower  haif  of  the  graphics  screen  that 
displays  the  vehicle  dashboard  is  used  to  display  help  information.  This  module 
controls  the  content  of  the  help  information. 

7.  Letter.c 

This  routine  was  developed  J.  Artero  and  R.  Kirsch  and  modified  by  L. 
Williamson.  This  module  creates  all  the  upper-case  Roman  alphabet  except  for 
G,  Q.  V,  W,  X  and  Z.  With  the  graphics  translate  and  rotate  command,  the 
appropriate  letters  are  selected  and  positioned  to  form  the  wording  on  the  surface 
of  the  road. 

8.  Integrates 

The  Euler-Heun  numerical  integration  method  is  implemented  in  this 
module  [Ref.  45],  When  the  vehicle  is  driven  in  manual  mode,  the  driver  controls 
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the  steering  wheel  with  the  movement  of  the  mouse.  However,  when  the  autopilot 
is  in  control,  the  steering  wheel  angle  for  the  dashboard  display  is  computed. 

9.  Display.c 

The  whole  dashboard  display  is  created  with  this  module.  The  vehic  ■-> 
dashboard  is  displayed  on  the  lower  half  of  the  graphics  screen.  Figure  4.1  shows 
the  various  parts  of  the  dashboard  display. 

10.  Road.h 

User  denned  constants  in  C  programming  are  extremely  important.  This 
feature  not  oniy  makes  software  modification  easier,  but  aiso  improves  program 
readaoiiitv.  Besides  the  system  defined  constants  that  can  be  accessed  by 
including  the  include  file.  gi.h.  user  defined  constants  are  kept  in  road.h.  This  file 
also  contains  any  additional  user  defined  type  sucn  as  Dimension. 

11.  Roadmap 

This  is  the  file  generated  by  the  module  map.c.  It  contains  the  roadmap 
that  defines  the  center  line  of  the  road  used  by  the  simplified  vision  model. 
Without  this  file,  the  simulation  will  not  run. 

12.  Makefile 

The  make  facility  in  UNIX  [Ref.  42]  is  a  very  useful  feature.  It  helps  solve 
a  lot  of  program  administration  problems  associated  with  large  software  projects 
involving  many  modules.  One  capability  that  it  provides  is  to  automatically 
recompile  only  the  files  that  have  changed.  The  make  feature  is  driven  by  an 
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special  file  call  Makefile.  This  special  file  defines  the  files  that  make  up  the  entire 
program. 

E.  SPECIAL  NOTES 

This  section  highlights  some  of  the  important  decisions  made  in  the 
simulation  program  that  must  be  understood  by  readers  who  may  intend  ro 
modify  and  improve  the  simulation. 

1.  45°  Branch  Cut 

This  feature  is  required  to  overcome  tne  problem  of  discontinuity  when 
the  arctangent  function  used  in  the  mam  module  crosses  the  ISO1'  boundary.  The 
solution  to  this  problem  adopted  in  this  work  assumes  that  the  maximum  vehicle 
heading  error  never  exceeds  45"  and  therefore  places  the  arctangent  branch  cut  at 

—45°  rather  than  at  the  usual  180°  location.  This  alteration  permits  the  road 
center  line  to  turn  270°  without  the  vehicle  encountering  a  discontinuity  in  o  or 

i>. 

2.  Convention  Difference 

One  of  the  issues  that  caused  much  programming  difficulty  initially  is 
that  the  x,  y,  and  z  axis  convention  adopted  in  the  mathematical  model 
developed  in  Chapter  III  differs  from  that  of  the  IRIS  graphics  implementation  in 
that  the  graphics  z  axis  in  screen  coordinates  is  directed  inward.  Anyone  wishing 
to  modify  the  programs  of  this  work  must  be  aware  of  this  difference. 
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3.  Roadmap  Size 


The  size  of  the  array  used  in  the  program  for  holding  the  roadmap,  that 
is.  the  road  center  line,  is  initialized  to  3000  points.  This  may  not  be  sufficient  for 
a  roadmap  with  a  smaller  interval  or  when  the  present  road  circuit  is  extended. 
Another  point  to  note  is  that  the  z  coordinate  of  the  road  point  is  included  so 
that  an  uneven  road  can  be  set  up  without  mucn  software  modification. 
Currently,  the  z  coordinate  is  set  to  zero. 

F.  SUMMARY  AND  CONCLUSIONS 

The  entire  grapnics  simulation  model  is  written  in  a  manner  that  allows  easy 
modification  and  expansion.  One  of  the  major  problems  with  software 
development  is  to  control  the  rippling  effect  of  future  code  updates.  Much 
attention  was  devoted  to  this  aspect  when  the  software  system  of  this  study  was 
designed. 

With  the  3D  color  graphics  simulation  model,  many  experiments  can  be 
carried  out  involving  both  human  and  autopilot  driving.  The  results  of  a  number 
of  such  experiments  are  documented  in  the  next  chapter.  The  source  code  of  the 
entire  simulation  model  is  included  in  the  appendix  for  those  who  need  to  access 
to  it  for  more  detailed  understanding  or  modification. 
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V.  EXPERIMENTAL  RESULTS 


A.  INTRODUCTION 

Many  simuiarion  runs  were  carried  out  with  different  model  characteristics  to 
test  the  validity  of  the  hypothesis  and  the  correctness  of  the  mathematical  model 
used.  The  results  of  the  3-D  simulation  runs  were  captured,  scaled,  and  formated 
into  3-D  plots  for  documentation  and  discussion. 

To  obtain  the  3-D  piots.  a  special  modification  was  made  to  the  main 
simulation  module.  The  purpose  of  the  modification  was  *o  capture  the  vehicle 
position  as  it  moves  and  to  record  its  deviation  from  the  road  center  line.  The 
information  is  stored  in  two  files  that  are  also  scaled.  The  scaling  is  based  on  the 
background,  figure  upon  which  this  information  is  overlaid  to  obtain  the  desired 
plot. 

The  figures  in  this  chapter  are  produced  with  a  very  flexible  and  easy-to-use 
graphics  package  called  OZDRAW  [Ref.  46].  Basically,  the  desired  background 
such  as  the  outline  of  the  road,  is  generated  with  OZDRAW  according  to  some 
scale.  The  information  given  by  the  modified  module  discussed  above  is  then 
used  by  OZDRAW  to  overlay  the  vehicle  positions  onto  the  road  outline.  The 
combined  image  is  then  labeled  and  printed  for  documentation. 
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B.  DESCRIPTION  OF  EXPERIMENTS 


The  entire  simulation  test  track  consists  of  four  400m  straight  road  segments 
connected  by  three  road  curves  with  80m  radius  to  form  an  open-ended 
rectangular  circuit.  However,  in  most  cases,  not  all  of  the  circuit  is  used  for 
capturing  the  experimental  resuits.  Rather,  all  but  a  few  of  the  experiments  were 
carried  out  for  a  short  segment  of  the  entire  circuit  which  included  a  200m 
segment  of  straight  road  followed  by  a  road  bend  and  then  another  stretch  of 
about  150m  of  straight  road. 

In  all  the  experiments,  tne  simulation  begins  bv  setting  the  velocity  to  the 
aesirea  value  and  putting  the  vehicie  5m  on  the  road  center  line.  For  autopilot 
driving  experiments,  the  autopilot  is  aiso  activated.  Except  for  Figure  5.3.  Figure 
5.4.  and  Figure  5.13,  the  simulation  stops  when  the  vehicie  crashes  or  when  it 
successfully  overcomes  the  bend  and  it  is  about  150m  down  the  second  segment  of 
the  straight  road.  The  results  of  Figure  5.3  and  Figure  5.4  are  obtained  by  driving 
the  vehicle  in  the  autopilot  mode  for  200m  on  the  straight  road.  Figure  5.13  is 
generated  by  autopilot  driving  around  a  270°  loop  with  a  radius  of  80m.  All  of 
the  experiments  use  the  nonlinear  mathematical  model  for  the  vehicle  developed 
in  Chapter  III.  A  comparison  between  the  linearized  model  and  the  nonlinear 
model  is  carried  out  with  two  experiments  to  show  their  relationship  and  the 
accuracy  and  usefulness  of  the  linearized  model  . 
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C.  MANUAL  DRIVING 


When  the  simulation  was'  first  developed,  the  mouse  buttons  were  used  to 
manually  drive  the  vehicle;  i.e.,  pressing  the  left  mouse  button  moved  the  vehicle 
to  the  left  and  pressing  the  right  mouse  button  moved  the  vehicle  to  the  right. 
This  was  found  to  be  an  uncomfortable  way  to  drive  the  vehicle.  The  method 
that  the  simulation  now  uses  is  found  to  be  much  better.  It  simply  involves 
moving  the  entire  mouse  to  the  left  or  to  the  right  to  steer  the  vehicle  to  the  left 
or  to  the  right  respectively.  This  method  of  driving  was  found  to  be  more  natural 
and  more  closely  resemble  actual  driving  conditions. 

Typical  results  for  human  driving  are  shown  in  Figtire  5.1  and  5.2.  In  Figure 

5.1.  the  vehicle  velocity  is  50  km/hr  and  at  this  speed  human  performance  is 
clearly  good.  When  the  vehicle  velocity  is  increased  to  75  km/hr,  shown  in  Figure 

5.2,  it  was  noted  that  performance  deteriorated  rapidly,  especially  when  going 
around  the  road  curve.  In  fact,  control  is  only  marginally  possible.  When 
attempting  a  cornering  at  this  speed,  several  trials  had  to  be  carried  out  before  a 
plot  was  obtained.  Several  attempts  to  manually  drive  the  vehicle  at  100  km/hr 
were  made,  but  all  were  unsuccessful.  It  should  be  noted  that  the  dots  on  these 
plots  as  well  as  all  other  figures  of  this  chapter  are  generated  at  a  rate  of 
approximately  6  Hz  and  therefore  they  are  more  spread  out  at  higher  vehicle 
speeds. 
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Figure  5.1  Manual  Driving 
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Parameters  used: 
velocity  time  constant 
turning  response  gain 
speed 


9.0 

0.02 

75  km /hr 


(Result  obtained  only  after  several  tries 


Figure  5.2  Manual  Driving 
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D.  COMPARISON  OF  LINEARIZED  AND  ACTUAL  MODEL 


The  next  two  experiments  were  conducted  to  demonstrate  the  effectiveness  of 
using  linearization  theory.  In  these  experiments,  the  vehicle  was  driven  by  the 
autopilot  on  a  200m  straight  road  using  the  pursuit  navigation  model.  For  each 
experiment,  two  runs  were  made.  The  first  run  used  the  4th  order  nonlinear 
model  of  Eq.  (3.10)  to  (3.13)  with  a  and  a  calculated  from  Eq.  (3.21)  and  Eq. 
(3.22)  respectively.  The  second  run  used  the  linearized  model  where  a  and  a  were 
computed  with  the  linearization  of  Eq.  (3.24)  and  Eq.  (3.25)  respectively.  The 
results  of  these  two  runs  were  overlaid  to  obtain  Figure  5.3  and  Figure  5.4. 
Figure  5.3  used  T  =  1  and  ky  =  l  resulting  in  A  =  —1.  This  means  thaT  the 
system  should  be  able  ro  correct  about  60%  of  its  deviation  from  the  center  line  in 
two  seconds.  Figure  5.4  used  T  =  2  and  k0  =  0.5  which  means  that  A  =  -0.5.  In 
this  case,  the  time  required  to  correct  the  same  amount  of  deviation  is  doubled  to 
four  seconds.  These  predictions  match  the  results  obtained  in  both  figures.  It  is 
also  observed  that  in  both  experiments,  the  linearized  model  used  is  a  very 
accurate  approximation  of  the  nonlinear  model.  Moreover,  the  good  agreement 
between  the  analytical  solution  and  the  numerical  solution  in  both  cases  provides 
a  measure  of  confidence  that  the  simulation  program  is  correct.  It  also  shows  that 

t 

the  sampling  rate  of  6  Hz  adopted  in  this  work  is  adequate  for  accurate  numerical 
integration  of  the  simulation  model  differential  equations. 
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Figure  5.3  Vehicle  displacement  from  road  center  line 
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Figure  5.4  Vehicle  displacement  from  road  center  line 
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E.  PURSUIT  NAVIGATION 


The  next  three  figures  show  the  performance  of  the  pursuit  navigation  model 
using  various  vehicle  velocities.  Figure  5.5  shows  that  at  50  km/hr,  the  vehicle 
was  able  to  keep  to  the  center  line  of  the  road  quite  well  while  turning  a  corner. 
Cornering  is  still  not  a  problem  when  the  vehicle  is  traveling  at  100  km /hr  as 
shown  in  Figure  5.6.  But  at  150  km/hr.  Figure  5.7,  the  vehicle  cannot  keep  itself 
on  the  road  when  turning  the  bend  due  to  its  inability  to  keep  to  the  center  of  the 
road. 

Using  the  same  pursuit  navigation  model,  another  set  of  experiments  was 
carried  out.  In  this  set  of  experiments,  ne  prediction  time  was  doubled  to  2 
seconds.  This  experiment,  as  shown  in  Figure  5.8  and  Figure  5.9.  shows  that  ’’he 
autopilot  performance  dropped  dramatically.  Due  to  the  longer  prediction  time,  at 
50  km/hr,  the  vehicle  tends  very  much  towards  the  inside  of  the  road  as 
compared  to  Figure  5.5.  At  100  km/hr.  the  vehicle  could  not  make  it  around  the 
bend  because  it  is  predicting  too  far  ahead.  However  on  a  straight  road,  the 
prediction  time  does  not  seem  to  matter.  This  corresponds  closely  to  the  author’s 
concept  of  human  driving.  When  we  are  driving  on  a  straight  road,  we  are 
normally  more  casual  than  when  we  are  trying  to  bring  the  vehicle  around  a  road 
bend;  that  is,  we  appear  to  shorten  or  lengthen  our  prediction  time  according  to 
the  road  conditions  and  the  driving  environment  instead  of  utilizing  a  constant 
prediction  time  as  in  this  simulation. 


77 


Figure  5.5  Driving  with  autopilot 
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Figure  5.6  Driving  with  autopilot 
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CRASH  ! ! 


Parameters  used: 


heading 

angle 

rate  gain  ~ 

1.0 

velocity 

time 

constant  - 

3.0 

turning 

response  gain  - 

0.02 

heading 

angle 

gain  - 

1.0 

prediction  ti: 

me  - 

1.0  sec 

speed 

= 

150  km/hr 

Pursuit  Navigation 


Figure  5.7  Driving  with  autopilot 
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Parameters  usee: 
heading  angle  rate  gain  =  1.0 
velocity  time  constant  =  9.0 
turning  response  gain  =  0.02 
heading  angle  gain  =  0.5 

prediction  time  =  2.0  sec 

speed  =  50  km/hr 


Pursuit  Navigation 


Figure  5.8  Driving  with  autopilot 
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CRASH  ! ! 


Parameters  used: 

heading  angle  race  gain 

= 

1.0 

velocity  time  constant 

= 

CO 

o 

turning  response  gain 

= 

0.02 

heading  angle  gain 

= 

0 . 3 

preciction  time 

= 

2.0  sec 

speed 

= 

100  km/hr 

Pursuit  Navigation 


Figure  5.9  Driving  with  autopilot 


F.  PROPORTIONAL  NAVIGATION 


The  pursuit  navigation  model  was  improved  with  another  gain  term  added  to 
the  vehicle  guidance  law.  This  made  it  into  a  proportional  navigation  model 
whose  performance  is  illustrated  by  Figures  5.10  through  5.12.  Comparing  Figure 
5.10  to  Figure  5.5.  it  can  be  seen  that  the  proportional  navigation  model  was  able 
to  maintain  its  position  on  the  road  center  line  more  diligently.  The  importance 
of  this  is  that  the  vehicle  is  now  capable  of  turning  the  road  bend  at  150  km/hr 
without  crashing  as  in  Figure  5.12.  This  was  not  possible  at  the  same  speed  with 
the  pursuit  navigation  model.  Figure  5.7. 

Another  important  observation  is  the  system's  response  to  deviation.  Based 
on  results  derived  in  Chapter  III.  Figure  5.5  to  Figure  5.7  should  have  a  total  time 
constant  of  2  seconds  whereas  Figure  5.8  to  Figure  5.12,  Figure  5.15  and  Figure 
5.16  should  have  a  total  time  constant  of  4  seconds.  As  seen  in  these  figures,  they 
match  the  predicted  preformance. 

Figure  5.13  shows  a  performance  comparison  between  the  proportional 
navigation  model  and  the  pursuit  navigation  model  when  the  vehicle  is  going 
around  a  270°  loop.  As  predicted  by  the  analysis  of  Chapter  III,  the  pursuit 
navigation  steering  law  produces  a  steady  displacement  of  the  vehicle  toward  the 
inside  of  the  turn.  This  effect  is  eliminated  when  proportional  navigation  is  used 
with  =  0.828,  again  as  predicted  by  linearized  system  analysis. 
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Parameters 


useci : 


heading  angle 

rate  gain  - 

0.S28 

velocity  time 

constant  = 

S  .0 

turning  response  gain  = 

0.02 

heading  angle 

gain  = 

0 . 294 

predicoion  ti: 

me  = 

1.17  sec 

speed 

= 

50  km/hr 

Proportional 


Navigation 


Figure 


5.10  Driving  with 


autopilot 
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Parameters  usee: 
neading  angle  rate  gain 
velocity  time  constant 
turning  response  gain 
heading  angle  gain 
prediction  time 
speed 


0.828 
9.0 
0.02 
0.294 
1 . 17  sec 
100  km/hr 


Proportional  Navigation 


igure  5.11  Driving  with  autopilot 


Parameters  used: 

heading  angle  rate  gain 

= 

0.328 

velocity  time  constant 

9.0 

turning  response  gain 

- 

0.02 

heading  angle  gain 

- 

0.294 

prediction  time 

- 

1  .  17  sec 

speed 

— 

150  km/hr 

Proportional  Navigation 


Figure  5.12  Driving  with  autopilot 
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Proportional  Navigation 


Total  time  constant  =  4  seconds 


Figure  5.13  Loop  Performance 
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G.  EFFECT  OF  VARIOUS  ROAD  POINT  SAMPLING  RATES 

The  last  set  of  experiments  carried  out  was  to  examine  the  effect  of  different 
sampling  frequencies  at  which  road  steering  points  are  selected  when  the  vehicle  is 
operating  in  autopilot  mode.  All  the  autopilot  driving  experiments  conducted 
previously  were  done  with  the  steering  point  being  selected  every  cycle.  Figures 
5.14  through  Figure  5.16  show  the  results  ootains  when  new  steering  points  are 
chosen  after  every  3  cycles.  5  cycles  and  7  cycles' respectively  with  a  1.17  second 
prediction  tune.  Comparison  of  these  figures  with  Figure  5.14  shows  that  choosing 
steering  points  less  often  actually  helps  tne  vehicle  to  negotiate  curves.  This  may 
seem  surprising  initially,  but  in  fact  snould  be  expected  since  reducing  the  roau 
sampling  rate  also  reduces  the  average  prediction  time.  There  is  of  course  a  limit 
to  the  extent  that  the  sampling  rate  can  be  lowered  since  the  steering  point  must 
not  be  allowed  to  pass  under  the  vehicle.  For  the  present  example,  since  T  =  1.17 
seconds,  the  maximum  interval  for  road  sampling  is  7  control  cycles  (because,  as 
previously  stated,  the  vehicle  steering  loop  was  operated  by  a  6  MHz  rate  for  all 
simulation  experiments). 

While  the  above  analysis  seems  to  say  that  the  apparent  human  strategy  of 
driving  toward  one  point  for  several  steering  cycles  is  effective,  one  negative  result 
of  this  approach  was  noted.  This  was  that  the  steering  wheel  motion  was  more 
jerky  than  in  earlier  simulations  in  which  a  new  steering  point  was  selected  on 
every  control  cycle.  Again,  this  is  not  surprising  since  reducing  the  average 
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Parameters  used: 
heading  angle  rate  gain 
velocity  time  constant 
turning  response  gain 
heading  angle  gain 
prediction  time 
speed 

road  point  selection  rate 


C.S28 

9.0 

0.02 

0.294 

1 . 17  sec 

100  km/hr 

3  cycles 


Proportional  Navigation 


Figure  5.14  Driving  with  autopilot 
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5.15  Driving  with 


autopilot 
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Parameters  used: 
heading  angle  rate  gain 
velocity  time  constant 
turning  response  gain 
heading  angle  gain 
prediction  time 
speed 

road  point  selection  rate 


0.32S 
9.0 
0.02 
0.294 
1  .  17  sec 
100  km/hr 
7  cycles 


Proportional  Navigation 


Figure  5.16  Driving  with  autopilot 
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prediction  time  should  tend  to  cause  the  system  to  become  somewhat 
underdamped  according  to  the  theory  of  Chapter  III. 

H.  SUMMARY 

The  results  in  this  chapter  show  that  the  hypothesis  about  the  unconscious 
behavior  of  human  driving  is  reasonably  well  in  agreement  with  reality.  It  also 
shows  that  the  mathematical  model  developed  in  the  eariier  chapter  is  a  useful 
model  for  mimicking  this  unconscious  behavior.  However,  much  more  work  is 
needed  to  obtain  statistical  information  about  how  human  gam  values  and 
prediction  rimes  vary  with  driving  conditions  before  any  degree  of  confidence  can 
be  attached  to  the  Hypothesis  of  this  work.  Regardless  of  the  results  of  such  a 
study,  however,  ‘he  hypothesis  used  for  unconscious  human  behavior  in  steering 
clearly  provides  a  viable  basis  for  autopilot  design  for  autonomous  vehicles. 
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VI.  SUMMARY  AND  CONCLUSIONS 


A.  SUMMARY 

This  research  work  differs  from  most,  previous  research  work  in  the  area  of 
lateral  control  of  autonomous  vehicles  in  the  sense  that  steering  laws  have  not 
generally  been  derived  explicitly  from  a  model  of  human  task  performance. 
Rather,  much  of  the  current  research  focuses  mainiv  on  vision,  sensors,  planning, 
navigation,  and  obstacle  avoidance.  So  far  as  the  author  knows,  none  has 
explored  the.  behavioral  aspects  of  human  driving  which  could  provide  some 
different  insights  into  possible  approaches  to  autonomous  navigation. 

As  observed  at  the  start  of  this  work,  human  driving  can  be  divided  into  two 
distinct  levels:  that  of  conscious  and  unconscious  behavior.  This  work  is 
concerned  entirely  with  studying  and  modeling  of  the  unconscious  aspect  of 
human  driving. 

Another  important  product  of  this  work  is  the  development  of  a  3-D  color 
graphics  simulation  model.  This  model  can  be  modified,  enlarged  and  enhanced 
to  incorporate  other  related  research  work  in  the  future.  With  this  model,  the 
experiments  are  more  interesting  and  realistic  than  using  simple  2-D  data  plots  as 
has  been  done  in  many  previous  simulation  studies. 
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B.  CONCLUSIONS  AND  POSSIBLE  EXTENSIONS 


In  this  work,  all  the  different  subsystems  such  as  the  vision  subsystem,  the 
vehicle  control  subsystem,  etc.,  are  treated  all  together  as  one  system.  This  is 
manageable  because  of  the  various  simplifying  assumptions  made  in  the 
mathematical  model  for  vehicle  and  driver  behavior.  One  direction  to  enlarge  this 
research  work  is  to  develop  a  more  sophisticated  vision  model.  The  present  vision 
mechanism  is  too  simple  and  assumes  perfect  vision  capable  of  "seeing"  a  point 
down  the  road  for  the  vehicle  to  steer  towards.  A  better  model  could  use  a  more 
elaborate  algorithm  and  techniques  such  as  texture  and  coior  analysis  to 
determine  the  various  road  features  and  to  estimate  the  road  edge  location. 

Anotner  possible  extension  to  this  work  is  to  study  the  conscious  aspect  of 
human  driving.  An  example  of  this  conscious  behavior  would  be  the  ability  to 
stop  the  vehicle  appropriately  when  the  vision  subsystem  "sees"  a  stop  sign  along 
the  road  or  an  obstacle  large  enough  to  prevent  the  vehicle  from  going  ahead 
further. 

In  conclusion,  the  author  hopes  that  this  research  work  can  serve  as  a  testbed 
and  motivation  for  a  more  elaborate  and  comprehensive  study  into  the  behavioral 
aspects  of  human  driving.  This  could  have  a  significant  impact  on  the 
development  of  viable  autonomous  vehicles  in  the  future. 
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APPENDIX  -  SOURCE  PROGRAM 


A.  CARSIMU.C 


This  is  the  main  program  of  the  entire  vehicle  simulation 
program.  To  recomDiie  this  program  jusr  issue  the  command 
Makefile. 

*  / 


^include  "road.h" 


GLOBAL  DECLARATIONS 


*  DO  NOT  remov  any  of  these  declarations. 

They  may  be  used  ;n  the  supporting  programs. 

Tag  transl4,  translS,  transl2,  transit,  transl.  trans22; 

Tag  housellooktag,  houseltranstag,  houselscaletag; 

Tag  houselooktag,  housetranstag,  housescaletag; 

Tag  dangertag,  temptag,  belttag,  braketag; 

Tag  odotagl.  odotag2,  odotag3,  odotag4; 

Tag  fuell,  roadlooktag.  skylooktag; 

Tag  steerwheeltag,  terrainllooktag; 

Coord  latri[3][2],  ratri[3j [2] ; 

float  fuelbar,speedbar; 

float  fuelquant  =  MAXFUEL;  /*  Maximum  fuel  available  */ 
float  heading_xpos  =  429.5;  /*  Heading  indicator  position  */ 

float  speedinc  =  1.0;  /*  Speed  increment/decrement  */ 

Device  keypressed; 

Boolean  start  =  TRUE;  /*  Start  of  program  flag  */ 

r 


Larger  turning_response_gain  corresponds  to  "stiff1 
steering  and  lower  value  corresponds  to  "sloppy" 
steering.  Large  velocity_gain  corresponds  to  sedan 
automobile  and  smaller  value  corresponds  to  sport  car. 
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Operator  has  control  over  steer_wheel_angle  and  speed 
using  the  mouse. 

Car  time  is  the  integration  timer. 


7 

float  state_vector  5j; 
float  cmd  psi  dot: 


float  heading_angle_rate_gain  =  1.0: 
float  velocity  time  consant  =  9.0: 
float  turning  response  gain  =  0.02: 
float  heading  angle  gain  =  1.0: 
float  steer  wheel  angle  =  0.0; 
float  prediction  time  =  1.0:  * 

float  steer  me  —  0.10: 

float  car  time  —  0.0: 


loat  aeitat 
float  SDeed 


=  0. 17. 
=  0.0: 


*  Unit  is  radian  * 
Unit  is  second 
Unit  is  radian 


IRIS  ailow  suen  a  larg^  array  oniv  if  it  is  global 
float  roadmap|5000h3l 


Dimension  Bendradiusl  —  80.0: 

Dimension  Roadwidth  -  16.0; 

Dimension  Roadlen  =  400.0: 

Angle  Fov  =  1000;  /*  Field  of  view  100  deg  */ 

main() 

{ 

/*****************^^^**»*******************************^**^**» 


LOCAL  DECLARATIONS 


******************************************************* 


int  old_sampling_cycle 
int  sampling  interval 
int  prev  mousex 
int  where 
int  distance 


=  -i; 

—  1;  /*  Steering  point  sampling  rate  */ 

=  250;  /*  Previous  mouse  x  position  */ 

=  1;  /*  Steering  point  location  */ 

=  0;  /*  Distance  travelled  */ 


char  thousandc[2],  hundredc[2],  tenc[2j,  unitc[2  ,  temp_string[l5j; 
int  i,  no  coord,  new  sampling  cycle,  mousex,  cal  mousex; 
int  count,  unit,  ten,  hundred,  thousand,  no_of_round; 

FILE  *fp; 

float  sigma_dot  =  0.0; 

float  tolerance  =  1.0; 
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float  old_sigma 
float  sigma 


=  0; 

=  0.0: 


float  prediction  distance; 
float  temp,  tempi; 
float  gx,  gy,  gz; 


extern  long  time();  /*  System  clock  */ 
char  timec(lO);  /*  Car  time  in  char  format  */ 

long  clocktime;  /*  For  clock  value  */ 

char  *clockc; 


Boolean 

Boolean 

Boolean 

Boolean 

Boolean 

Boolean 

Boolean 


showclock  =  TRUE;  /*  Display  clock  flag  * 
showtimer  =  FALSE;  /*  Display  integration  timer  * 
alarm  =  FALSE;  /*  Off  road  warning  flag  */ 
bell  =  FALSE;  *  Turn  off  danger  alarm  * / 
debug  =  TRUE:  Turn  off  debug  info  */ 

autop  =  FALSE:  *  Turn  off  debug  info  * 

ebrake  =  FALSE;  *  Emergence  brake  flag 


Dimension  consumption  =  1.0:  t*  Fuel  consumption 

Dimension  crashdown  =  0.0:  *  Off-road  display  flag 

Dimension  fueldown  =  0.0;  /*  Fuel  depleted  display  flag  */ 

Dimension  headingdeg  =  0.0;  *  Heading  in  degrees  * 

Dimension  headingrad  =  0.0;  *  Heading  in  radians  * 

Dimension  rdistance  =  0.0;  *  Distance  travelled 

Dimension  vd  =  100.0;  /*  Viewing  distance  */ 

Dimension  mps  to  kmph  =  3.6;  /*  m/s  to  km/hr  conversion  */ 

Dimension  rad  to  deg  =  360 /  ( 2  *  PI) ;  /*  radian  to  degree  conversion  */ 

Coord  crashx  =  512.0;  /*  X  viewport  coord  to  detect  off-road  */ 

Coord  crashy  =  385.0;  /*  Y  viewport  coord  to  detect  off-road  */ 

Coord  warnxl  =  212.0;  /*  X  viewport  coord  to  warn  off-road  */ 

Coord  warnx2  =  812.0;  /*  X  viewport  coord  to  warn  off-road  */ 

Coord  warny  =  385.0;  /*  Y  viewport  coord  to  warn  off-road  */ 

Colorindex  colors! lj;  /*  Array  to  store  color  of  crash  spot  */ 
short  nopixel  =  1;  /*  No  of  pixel  to  detect  off-road  */ 

Coord  cx,  cy,  cz;  /*  Current  viewing  point  */ 

Coord  rx,  ry,  rz;  /*  Reference  point  */ 

Coord  pz,  px;  /*  Last  viewing  point  */ 

Object  speedometer,  fuel,  steerwheel,  signboard,  sky,  mountain; 

Object  terrainl,  odometer,  warning,  heading  meter; 

Object  road,  help,  arrow,  house,  housel; 
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SYSTEM 


INITIALIZATIONS 


*******»-***************************3|e************:************  / 


/*  Initial  state  vector  of  the  automobile  */ 

state  vectorllj  =  0.0;  /*  initial  z  coord  */ 
state_vector[2  —  0.0;  /*  initial  x  coord  */ 
state  vecton3  =  0.0;  /*  initial  velocity  x 
state_vectori4  =  0.0;  /*  initial  heading  */ 

cx  =  0.0;  cv  =  3.0;  cz  =  0.0; 
rx  =  0.0;  ry  =  3.0;  rz  =  -vd; 

count  =  unit  =  ten  =  hundred  =  thousand  =  0; 

ginit(); 

doublebuffer(); 
gconfigf): 
cursoff( ) : 

qdevice(KEYBD); 

viewport(0,  XMAX5CREEN.  0.  YMAXSCREEN); 
ortho2(0.0.  1023.0.  0.0.  767.0): 

blink(10.  CYAN.  255,  0,  0); 
bbox2i(5.  5.  0.  1023,  0,  767); 

mapcolor(  MOUNT  AIN.  199,  123.  63); 
mapcolor(MOUNTAINl,  210,  150,  0); 
mapcolor(FIELD,  5.  190,  20); 
mapcolor(SKY,  50,  8,  155); 
mapcolor( WARN,  125,  0,  0); 

mapcolor(CHM  WALL  1.1 18,76,0); 
mapcolor(CHM  WALL  2, 146,1 14,0); 
mapcolor(  WINDOW, 0, 14 1,205) ; 
mapcolor(SIDEROOF,  188,50, 14); 
mapcolor(  FRA  ME,  118,50.14); 
mapcolor(  WALL,  164,1 1 1,0); 
mapcolor(SIDE  WALL,  146,94,1); 
mapcolor(ROOF,  148,50,14); 

/*  Dark  Grey  */ 
mapcolor(ROOFl,  100,100,100); 

/*  Light  Grey  */ 
mapcolor(FRAMEl,0,60,60); 

/*  Light  Grey  */ 
mapcolor(SIDEWALLl,150,60,60); 

/*  Pink  V 

mapcolor(  WALLl  ,160,60,60); 


setvaiuator(MOUSEX,  250,  0,  500); 
setvaluator(MOUSEY,  250,  0,  500); 
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noise(MOUSEX,  10); 


^* ************************************************  ************ 
MAKE  ALL  THE  OBJECTS 

*************************************************************  i 

makethespeedometerf  ^speedometer) ; 
makeheading  ( Sheading  _meter); 
makesteerwheel)  &steerwheel) ; 
maketheodometer(  hodometer); 
maketerrainl(&terrainl); 
makewarning(  ^warning): 
maketheroad(&road) ; 
makehouself&housel); 
makehouse(  Chouse); 
makethesky  (&sky); 
makehelp(&help); 
makefuel(&fuel); 

/*  Display  the  introductory  image 
welcome(); 

^*  ******  *************±****X***-K*XX:*X*X*X*XXXX±*X*****X*X*X*XXX 


READ  ROADMAP 


*************************************************************  / 


/*  Read  road  map  into  system  */ 

if  ( (fp  =  fopen(MroadmapM,MrM))  ==  NULL) 

{ 

printf(T,Cannot  read  roadmap. \n"); 
return(-l); 

} 

else 

for  (i  =  0;  !feof(fp);  -f-hi) 

fscanf(fp,n%f  %f  %P\  &roadmap'i][0j,  ^roadmap^]]^, 
&roadmap[i][2j); 

no  coord  =  — i; 


setbell(T); 
ringbellf); 
setbell  ( ’2  ’ ) ; 
ringbell  ( ) ; 


j************************************************************* 


INITIALIZE  BUFFERS 
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/ 


/*  Wait  till  a  mouse  is  pressed.  */ 

while(getbutton(MOUSE3)  ==  0); 

color(BLACK); 

clear(); 

swapbuffers(); 

clear(): 

swapbuffers(); 


/******************:************ c  *  *  * 

/ 


MAIN  SIMULATION  LOOP 


while(TRUE) 

{ 

new  sampling  cycle  =  count .  sampling  interval: 


pz  =  cz: 
px  =  cx; 


clocktime  =  time((long  *)  0); 
clockc  =  ctime(&:clocktime); 

/*  To  display  clock?  *■ 

if  (keypressed  ==  V  ||  keypressed  ==  ’C’) 
if  (showclock)  showclock  =  FALSE; 
else  showclock  =  TRUE; 

/*  Sound  alarm  around  2m  before  off  the  road  */ 

cmov2(warnxl,  warny); 
readpixelsfnopixel.  colors); 

if  (colorstO]  !=  BLACK  &&  colors[0]  !=  WHITE) 
alarm  =  TRUE; 
else  alarm  =  FALSE; 

if  (lalarm) 

{ 

cmov2(warnx2,  warny); 
readpixelsfnopixel,  colors); 

if  (colorslOj  !=  BLACK  &&  colors[0j  !=  WHITE) 
alarm  =  TRUE; 
else  alarm  =  FALSE; 

} 


/*  Check  if  the  vehicle  is  off  the  road 
IMPT  :  Assume  road  surface  is  black 
and  surface  signs  are  white  */ 
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cmov2(crashx.  crashy); 
readpixels(nopixel,  colors); 

if  (colors[0j  !=  BLACK  &&  colorsjO]  !=  WHITE) 
crashdown  —  -1000.0; 

rz  =  -  (vd*cos(state  vecton4])  4*  state_vector[l  ); 
rx  =  vd*sin(state  vector  4] )  4-  state  vector[2(; 

if  (keypressed  ==  ’q’  ||  keypressed  ==  ’Q’) 
if  (autop) 

{ 

autop  =  FALSE: 
prev^mousex  =  mousex: 

} 

else  if  (state  vector!*  >  0)  autop  =  TRUE; 

#ifdef  DEBUG 

for ( i  =  1;  i  <=  SYSTEM_ORDER:  -- ri) 

switch(i) 

{ 

case  1: 

printf(f?X:  %.2f  ,f. state  vector  1); 
break: 
case  2: 

printf(f,Y:  %.2f  M, state  vector  2  ): 
break: 
case  3: 

printf(n Velocity:  %.2f  state  vector  3  *mps  to  kmph); 
break; 
case  4: 

printf(ffHeading:  %.2f\nn, state  vector  4  *  rad  to  deg); 
break; 

} 

#endif 

cz  =  -state_vector[l  ; 
cx  =  state  vector“2j; 

/*  Check  if  keyboard  pressed.  Keys  pressed  are  queued.  */ 
checkkeybd(); 

mousex  =  getvaluator(MOUSEX); 

if  (!autop  !ebrake) 

{ 

if  (getbutton(MOUSEl)  &&  getbutton(MOUSE2) 

&&  getbutton(MOUSE3)) 

/*  Exit  Program  */ 

break; 
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else  if  (getbutton(MOUSEl)  ||  (keypressed  ==  V 
kevpressed  ==  ’A’)) 

{ 

if  (speed  <  190) 

{ 

start  =  FALSE; 

speed  ==  speed  4-  speedinc; 

} 

else  speed  =  190.0;  /*  Top  Speed  */ 

} 

else  if  (getbutton(MOUSE3)  ||  (keypressed  ==  V 
kevpressed  ==  E')) 

{ 

/*  Emergency  brake  */ 
ebrake  =  TRUE: 

*  state  vector  3  =  0.0: 
speed  =  0.0:  * 

} 

else  if  (getbutton(MOUSE2)  (keypressed  ==  ?b" 
kevpressed  ==  B’)) 

{ 


Decrease  speed 

if  (speed  >  0) 

speed  =  speed  -  speedinc; 
else  speed  =  0.0; 

} 

}  /*  if  (lautop)  V 

A 

if  (lebrake  &:&:  state  vector  3  >  0) 

{ 

prediction  distance  =  state  vector[3]  *  prediction  time; 

r 

"where1*  is  passed  to  find  subgoal  so  that  searching 
need  not  always  start  from  the  beginning  of  the  road. 

The  z  and  y  convention  in  the  graphics  system  is  reversed. 
Also  the  sign  is  going  in  the  opposite  direction.  So 
compensate  before  passing  into  find  subgoal. 
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wrhere  =  find  subgoal(roadmap,  no  coord,  where,  tolerance, 
prediction_distance,  cx,  -cz,  0.0); 

} 

if  (lebrake  &&  (autop  &&  old  sampling  cycle  <  new  sampling  cycle 
||  lautop)) 


IOC 


{ 

old  sampling  cycle  =  new_sampling_cvcle: 
if  (where  <  0) 

{ 

/*  Stop  completely  and  remove  autopilot  *  ! 
ebrake  =  TRUE: 

/*  state  vector'3;  =  0.0; 
speed  =  0.0;  */ 
autop  =  FALSE: 

} 

else 

{ 

gx  =  roadmapiwhere/0); 
gy  =  roadmapiwhereijl  ; 
gz  =  roadmap  where  2 j ; 

} 

} 

*  Convention  difference:  Z-axis  in  graphics  is  Y-axis  in 
mathematical  model.  Also  Z-axis  is  negative  when  moving 
into  cne  screen  which  therefore  must  be  converted  to 
positive  for  our  calculation. 


temp  =  -cz: 

sigma  =  atan2((gx-cx),(gy-temp)); 

,  *  Sigma_dot(0)  =  0  * 

if  (count  ==  0)  old^sigma  =  sigma; 

/*  This  is  45  deg  branch  cut  to  handle  the  discontinuity 
when  arc  tangent  function  crosses  PI  and  -PI  */ 

if  (sigma  <  -(PI/4))  sigma  =  2*PI  +  sigma; 

#ifdef  DEBUG 

printf(ngx  %.2f  cx  %.2f  gy  %.2f  cz  %.2f’,gx.  cx,  gy,  cz); 
printf(,T  sigma_deg  %.2f\n" ,(sigma/(2*PI))*360); 

#endif 

sigma  dot  =  (sigma  -  old  sigma) /deltat; 

cmd_psi  dot  —  (heading  angle  rate  gain  *  sigma  dot)  + 
(heading_angle  gain  *  (sigma  -  state  vector[4])); 


if  (autop) 

steer  jwheel_angle  =  cmd_psi_dot/ 

(turning_response  gain  *  state  vector[3]); 

old_sigma  =  sigma: 


if  (lebrake  &&  lautop) 

{ 
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/*  Manual  Driving  */ 

cal_mousex  =  mousex  -  prev_mousex; 

steer  wheel  angle  =  steer  wheel  angle  —  (float)  cal  mousex/100 
prev_mousex  =  mousex; 

} 

compute  new jstate(autop); 

/*  Clear  the  vehicle  window  */ 

viewport(0.  XMAXSCREEN.  335.  YMAXSCREEN); 

color(FIELD); 

clear(); 

/*  Clear  the  display  panel  */ 

viewporc(0.  XMAXSCREEN.  0.  380): 

coiorf  WHITE): 

clear(); 

Reset  viewport 

viewport(0,  XMAXSCREEN.  0.  YMAXSCREEN); 

*  Calculate  the  velocity  for  emergence  brake 
if  (ebrake) 

{ 

/*  every  16.0  km/hr  or  4.0  mph  will  take  the 
vehicle  one  additional  cycle  to  stop.  * 

state  vector  3  =  state  vector  3  -  4.0; 
speed  =  state  vector  3  ; 
if  (state_vector! 3  <  0) 

{  " 

ebrake  =  FALSE; 
state_vector[3j  =  0.0; 
speed  =  0.0; 

} 

} 


/*  Calculate  distance  travelled  */ 

rdistance  =  rdistance-^sqrt((cz-pz)*(cz-pz)  —  (cx-px)*(cx-px)); 

if  (keypressed  ==  ’o’  ||  keypressed  ==  ’O’)  rdistance  =  0.0; 

distance  =  (int)  rdistance; 

thousand  =  distance/1000; 

hundred  =  (distance  -  thousand*  1000) / 100; 

ten  —  (distance  -  hundred  *  100  -  thousand*  1000)/10; 

unit  =  distance  -  ten  *  10  -  hundred  *  100  -  thousand*  1000. 
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if  (unit  ==  10)  {  unit  =  0;  -f-^ten;  } 
if  (ten  ==  10)  {  ten  =  0;  ——hundred;  } 
if  (hundred  ==  10)  {  hundred  =  0;  —  -^thousand:  } 
if  (thousand  ==  10)  thousand  =  0; 
sprintff  timec ,  M%5 .2f’  ,car_time) ; 
sprintf(thousandc,M%dM,  thousand); 
sprintf(hundredc,M%dn, hundred); 
sprintf(tenc,"%d",ten); 
sprin  tf(  unite,  n%d,r,unit-f— ); 

DISPLAY  HELP  PANEL  * 

callobj(help); 

/*  EDIT  SKY  * 

editobj(sky); 
objreplacel  sky  look  tag); 
look  at  ( cx.cy.cz. rx.ry.rz.0.0): 
closeobj  ( ) ; 
callobj(sky): 

*  EDIT  TERRAIN  * 

editobj  ( terrain  1); 
objreolacef terrain  liooktag): 
Iookat(cx.cy,cz.rx,rv,rz.0.0); 
closeobj  (); 
callobj(terrainl); 

r  EDIT  ROAD  7 

editobj(road); 

objreplace(roadlooktag); 

lookat(cx,cy,cz,rx,ry.rz,0.0): 

closeobj  (); 

callobj(road); 

r  EDIT  HOUSES  */ 

editobj  (house); 

objreplace(houselooktag); 

lookat(cx,cy,cz,rx,ry,rz,0.0); 

objreplace(housetranstag); 

translate(-80.0,  0.0,  -50.0); 

objreplace(housescaletag); 

scale(0.40,  0.40,  1.0); 

closeobj(); 

callobj  (house); 

editobj  (housel); 
objreplacef  house  llook  tag); 
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lookat(cx,cy,cz,rx,ry  ,rz,0.0); 
objreplacef  house  ltrans  tag); 
translate(-30.0,  0.0,  -10.0); 
objreplace(houselscaletag); 
scale(0.50,  0.50.  1.0); 
closeobj(); 
callobj(housel); 

editobj(housel); 
objreplace(house  llooktag): 
lookat(cx.cy.cz.rx.ry.rz.O.O); 
objrepiace(houseltranstag); 
transiate(-30.0.  0.0.  -15.0); 
objrepiace(  house  lscaletag); 
scale(0.50,  0.50.  1.0); 
closeobj(); 
callobj(housel); 

editobjf  house): 

objre  placet  nouselooktag) ; 

lookat(  cx,cv.cz. rx,ry.rz.0.0); 

objrepiacet  housetransrag  j; 

translate!  100.0.  0.0.  -Roadlen  2): 

obireplacefhousescaietagj; 

scale(0.50.  0.50.  1.0); 

cioseobj(); 

callobj(house); 

editobj(house); 

objreplace(houselooktag) : 

lookat(cx,cy,cz.rx,ry,rz,0.0); 

objreplace(housetranstag); 

translate(-40.0,  0.0,  -Roadlen  -  100.0); 

objrep^ace(housescaletag); 

scale(0.80,  0.80,  1.0); 

closeobj(); 

callobj  (house); 

editobj(housel); 
objreplace(housellooktag) : 
lookat(cx,cy,cz,rx,ry,rz,0.0); 
objreplace(  house  1  transtag); 
translate(300.0,  0.0,  -Roadlen  -  55.0); 
objreplace(  house  lscaletag); 
scale(0.50,  0.50,  1.0); 
closeobj  (); 
callobj(housel); 

/*  EDIT  STEERING  WHEEL  */ 

editobj(steerwheel); 

objreplace(steerwheeltag); 


rotate((int)  -(steer_wheel_angle  *  10  rad_to_deg),  ’Z'): 

closeobj(); 

callobj(steerwheel); 

/*  EDIT  ODOMETER  */ 

editobj  (odometer); 

objreplace(odotagl); 

charstr(thousandc); 

objreplace(odotag2); 

charstr(hundredc); 

objreplace(odotag3); 

charstr(tenc): 

objreplace(odotag4); 

charstr(unitc); 

closeobj(): 

callobj  (odometer) ; 

if  (showclock) 

{ 

coior(  WHITE); 
cmov2i(100,  750); 
charstr(ciockc); 
color(BL  ACK); 

} 

if  (autop) 

{ 

color(CYAN); 
cmov2i(400,  750); 
charstr(MAutoPilot  Mode11); 
color(BLACK); 

} 


/*  TESTING  AREA  */ 

if  (keypressed  ==  ’z’  ||  keypressed  ==  ’Z5) 
if  (debug)  debug  —  FALSE; 
else  debug  =  TRUE; 


if  (debug) 

{ 

cmov2i(575,  280); 

charstr(MCommand  Speed  (km/h)  ”); 
sprintf(temp_string,tf%.2F', speed  *  mps_to_kmph); 
charstr(temp_string); 

cmov2i(575,  250); 
charstr(MSteering  (degree)  Tt); 

sprintf(temp_string,M%.2F',steer_wheel  angle  *  rad  to  deg); 
charstr(temp  string); 
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/*  cmov2i(575,  220): 
charstr("Mousex  "); 
sprintf(temp_string,"%d",cal_mousex); 
charstr(temp_string);  *; 

cmov2i(575,  180); 

charstr(ffTurning  Response  Gain  M); 
sprintf(temp  string,"%.3f \turning_response_gain) 
charstr(temp  string); 

cmov2i(575,  150); 
charstr("Heading  Angle  Gain  ,f); 
sprintf(temp_stnng,n0:o.3r,.heading_angle_gain); 
charstrftemp  string); 

cmov2i(575.  120): 
charstr(MPrediction  Time  M): 
sprintf(temp  string. "°T2f ’.prediction  time): 
charstr(temp  string): 

f 

*  EDIT  TIMER  * 

if  (keypressed  ==  V  keypressed  ==  ’T’) 
if  (showtimer)  showtimer  =  FALSE: 
else  snowtimer  =  TREE: 


if  (showtimer) 

{  c m o v 2 i ( 5 7 5 ,  310); 
charstr(MIntegration:  ,?); 
charstr(timec):  } 

/*  EDIT  WARNING  INDICATOR  */ 

if  (state_vector[3]  >  0) 

{  editobj(warning); 
objreplace(braketag); 
color(  WARN); 
if  (alarm) 

{ 

if  (keypressed  ==  ’s’  |j  keypressed  ==  ’S’) 
if  (bell)  bell  =  FALSE; 
else  bell  =  TRUE; 

if  (bell) 

{ 

setbell(’2’); 
ringbell  ( ) ; 

} 

objreplace(dangertag); 

color(CYAN); 

} 
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{ 

objreplace(dangertag); 
color(  WARN); 

} 

/*  ENGINE  WARMING  UP  */ 

if  (count  <  1000) 

{  objreplace(temptag); 
color  (WARN);  } 

*  ENGINE  REACHED  NORMAL  TEMPERATURE  * 

if  ((count  >  1000)  &;&  (count  <  5000)) 

{  objreplace(temptag); 
color( YELLOW);  } 

*  ENGINE  OVERHEATING  * 

if  (count  >  5000) 

{  objrepiacef tempcagj : 
coior(RED);  } 

objreplace(beictag): 

coiorf  WARN): 

closeobj();  } 


/*  BRAKE  SIGNAL  FOR  CAR  STOP  *  ' 

{ 

editobj(warning); 

objreplace(braketag): 

color(RED); 

closeobj(); 

} 

callobj  (warning) : 

/*  EDIT  HEADING  INDICATOR  */ 

/*  Compute  heading  using  vehicle  state  vector  */ 

if  (state_vector  4  <  0.0)  headingrad  =  2*PI-rstate  vector  4  ; 

else  headingrad  =  state  vector  4j; 
no_of_round  =  (headingrad*  180. 0/PI)/360.0; 
headingdeg  =  headingrad*  180.0/PI  -  (float)  no_of  round*360; 

editobj(heading  meter); 
objreplace(transll); 

translate(heading  xpos-20.0-4.5*headingdeg.  4.0,  0.0); 
closeobjQ; 
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callobj(heading_meter); 

/*  EDIT  SPEEDOMETER  INDICATOR  * 

/*  2.5  factor  is  for  converting  to  the  dashboard  display 

speedbar  =  181.0  -  state  vectorlS]  *  mps  to  kmph  *  2. 

editobj(  speedometer); 
objreplace(transl4); 
translate(0.0.  speedbar.  0.0); 
closeobjj); 

callobj  (speedometer ) : 

/*  EDIT  FUEL  GAUGES  * 

*  Stop  :  no  consumption  * 

*  Speed  above  100  :  consumption  is  20%  higner  * 

if  (star,p_vector  0  >  0.0) 

if  jstate_vector  5  <  100.0) 

fuelquant  —  fuelquant  -  consumption: 

eise  fuelquant  =  fuelquant  -  1.2*  consumption 

fuelbar  =  fuelquant/  MAXFUEL*320.0— 14.0: 

if  (fuelquant  <  0.0)  fueldown  —  -1000.0: 

editobj(fuel); 

objreplace(fuell); 

rectf(  106. 0,14. 0,149.0. fuelbar); 

closeobj(); 

callobj(fuel); 

/*  EDIT  CRASH  INFO  DISPLAY  FOR  OFF-ROAD 

pushmatrix(); 

pushattributes(); 

translate  (O.O.crashdown,  0.0) : 

/*  Set  all  warning  lights  when  crash  * 

if  (crashdown  ==  -1000) 

{ 

autop  =  FALSE; 

editobj  ( warning); 

objreplace(braketag); 

color(RED); 


bell  =  FALSE; 

objreplace(dangertag); 

color(RED); 

objreplace  ( tempt  ag); 
color(RED); 

objreplace  (belttag); 
color(RED); 

closeobj(): 

callobj(warning): 

} 

colorfRED): 

rectf(0. 0,1 385. 0.1023. 0.1 767.0); 


color(BLACK); 
cmov2i(370.1576): 
charstrl M  CRASH"); 
cmov2i(370.1560): 
charstr( !,OFF  THE  ROAD"); 


cmov2i(370.1544): 

charstr("PUSH  ALL  THREE  MOUSE  BUTTONS  TO  EXIT"); 

popattributes(); 

popmatrix(); 

/*  EDIT  CRASH  INFO  DISPLAY  FOR  FUEL  DELETION  */ 

pushmatrixQ; 

pushattributes(); 

translate(0.0,fueldown,0.0); 

color(MAGENTA); 

rectf(0.0, 1385.0, 1023.0,1767.0); 


color(BLACK); 
cmov2i(370,1576); 
charstr("STOP"); 
cmov2i(370,1560); 
charstr("FUEL  DEPLETED"); 

cmov2i(370,1544); 

charstr("PUSH  ALL  THREE  MOUSE  BUTTONS  TO  EXIT"); 
popattributesQ; 
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popmatrix(); 


swapbuffersQ; 

^-rcount; 

}  /*  while  loop  */ 

color(BL  ACK); 
clear(); 
swapbuffersQ; 
clearQ; 

swapbuffers(); 
finish(); 
gexit  ( ) ; 

}  /*  main  * 


Xx*xxxxx 


xxxxxxxxxxxxxxxxxxxx:?xxxxxxxxxx*:xx 


CHECK  KEYBOARD 

/  *  Keyboard  keys  can  be  used  to  controlled  steer  wheel  angle. 
Keys  pressed  are  queued  whereas  the  mouse  is  not. 

Keys  increase  tne  angle  by  a  smaller  amount. 

checkkevbd() 

{ 

key  pressed  =  NULL; 

if  (qtest()) 

{ 

qread(&keypressed) ; 

/*  Display  help  information  */ 

if  (keypressed  ==  ’h’  ||  keypressed  ==  ’H’) 
help(); 

/*  printf(M%d\nM, keypressed);  */ 

} 

}  /*  checkkeybd  * 
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B.  Circuit. c 


/* 

Build  the  entire  road  circuit. 

*  / 

/ 

^include  Mroad.h” 

extern  Tag  roadlooktag; 
extern  float  Roadwidth.  Roadlen; 
extern  float  BendradiusI; 
extern  Angie  Fov; 

/*:**sit*xx>icx*:*:ait***xxxx*xxx*x:i:xxxxa!s*xxxxxx:iic2¥:x*xx:iicxxx 


BUILD  THE  RALLY  CIRCUIT 


Ic^cxxxxXXxxxxxXxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


maketheroad(road) 

Object  *road: 

f 

i 

Dimension  temp,  i: 

Dimension  high  —  3.2; 

Colorindex  signbg  =  YELLOW; 

Colorindex  upsign  =  RED; 

Colorindex  rightsign  =  BLUE; 

*road  —  genobj(); 
makeobj  (*road): 
pushmatrix(); 
pushviewport(); 

viewport(0,  XMAXSCREEN,  385,  YMAXSCREEN) ; 
setdepth(0,1023); 

perspective(Fov,  1023.0/385.0,  0.0,  1023.0); 

roadlooktag  =  gentag(): 

make  tag  (road  look  tag); 

lookat(0.0.  0.0,  0.0,  0.0,  0.0,  0.0,  0); 

/*********************** ******** 


FIRST  STRETCH  OF  ROAD 


********************************  j 

surf(0.0,  0.0,  0.0,  Roadwidth,  Roadlen,  BLACK); 
/* 
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Build  the  sign  "START 


temp  =  -5.5; 
colorf  WHITE): 
pushmatrixf); 

translate(temp  -f  4.0,  0.0,  0.0); 
rotate(-900/X’); 
letter(T\  BLACK): 
popmatrix(); 

colorf  WHITE); 
pushmatrixf); 

translateftemp  4-  2.0.  0.0,  0.0); 
rotatef-OOO/X’): 
letterf’R’.  BLACK): 
popmatrixf); 

colon  WHITE); 
pushmatrixf ): 
translate! temp.  0.0.  0.0); 
rotatef-900.  X‘); 
letterfW.  BLACK): 
popmatrixi ); 

colorf  WHITE): 
pushmatrix(); 

translateftemp  -  2.0.  0.0,  0.0): 
rotate(-900/XJ); 
letterf’T’,  BLACK); 
popmatrixf); 

colorf  WHITE); 
pushmatrixf); 

translateftemp  -  4.0,  0.0,  0.0); 
rotatef-900, ’X’); 
letterf’SL  BLACK); 
popmatrixf); 

/* 

Build  the  sign  "TURN"  before  the  bend 

7 

colorf  WHITE); 
pushmatrixf); 

translatef-2.0,  0.0,  -(Roadlen  -  5.0)); 
rotatef-900, ’X’); 
letterf’N’,  BLACK); 
popmatrixf); 
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color(  WHITE); 
pushmatrixQ; 

translate(-4.0,  0.0,  -(Roadlen  -  5.0)); 
rotate(-900,’X’); 
ietterQR’,  BLACK); 
popmatrixQ; 

color(WHITE); 

pushmatrix(); 

translate(-6.0.  0.0,  -(Roadlen  -  5.0)); 
rotate(-900,’XQ; 
letterQU’,  BLACK); 
popmatrixQ; 

color(  WHITE); 
pushmatrix(); 

cranslate(-8.0.  0.0.  -(Roadlen  -  5.0)); 
rotate(-900,5X’); 
letter) ’T’.  BLACK); 
popmatrixQ; 


Build  a  senes  of  arrow 


for  (temp  =  8.0;  temp  <  Roadlen;  temp  -*-=  40.0) 

{ 

pushmatrix(); 
translate(0.0,  0.0.  -temp); 
rotate(-900,JX’); 

polyarrow(0.7,  1.2,  0.0,  WHITE); 
popmatrixQ; 

} 


r 

Create  1st  uparrow  signboard 
*  / 

pushmatrixQ; 
translate(10.0,  0.0,  -5.0); 
signb(l.9,  2.5,  3.0,  signbg); 
popmatrixQ; 
pushmatrixQ; 
translate(10.0,  high,  -5.0); 
polyarrow(0.7,  1.2,  0.0,  upsign); 
popmatrixQ; 
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Create  2nd  uparrow  signboard 


pushmatrix(); 

translate(-7.0,  0.0,  -(Roadlen/3.0)); 
signb(1.9,  2.5,  3.0,  signbg); 
popmatrix() ; 
pushmatrix(); 

translate(-7.0,  high,  -(Roadlen / 3.0)); 
polvarrow(0.7,  1.2.  0.0,  upsign); 
popmatrLx(); 


First  road  bend 


pushmatrixi  j . 

translate! Bendradius i  -  Roaawidth  2.  0.0.  -Roadlen): 
rotate(-900.  ‘X’); 
bend( ); 
popmatnx( ): 


Build  lnd  right  turn  signboard 


pushmatrix(): 

translate(7.0,  0.0,  -(Roadlen-5.0)); 
signb(  1.9,  2.5,  3.0,  signbg); 
popmatrix(); 
pushmatrix() ; 

translate(6.3,  4.0,  -(Roadlen-5.0)); 
rotate(-900,’Z’); 

polyarrow(0.7,  1.2,  0.0,  rightsign); 
popmatrix(); 


SECOND  STRETCH  OF  ROAD 


********************************! 


pushmatrix() : 

temp  =  Bendradiusl  -  Roadwidth/2; 
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translate(temp,  0.0,  -Roadlen  -  temp); 
rotate(-900,  ’Y’); 

surf(0.0,  0.0,  0.0,  Roadwidth.  Roadlen,  BLACK); 
popmatrixQ; 

r 

Build  a  series  of  road  strips 


for  (i  —  temp  -r  8.0;  i  <  Roadlen;  i  — =  20.0) 


pushmatrix(); 

translate^,  0.0,  -Roadlen  -  temp); 
surf(0.0,  0.0,  0.0.  3.0.  1.0.  WHITE); 
popmatrixQ; 

X 


Create  3rd  uparrow  signboard 


Dusnmatnxf ); 

transiate(temp  —  50.0,  0.0,  -K,oadlen  -  temp  -  Roadwidth); 

rotate(-900,’Y’); 

signb(l.9,  2.5,  3.0,  signbg); 

popmatrixQ; 

pushmatrix(); 

translate(temp  +  50.0,  high,  -Roadlen  -  temp  -  Roadwidth) 

rotate(-900.’YQ; 

polvarrow(0.7,  1.2,  0.0,  upsign); 

popmatrix(); 

r 


Second  road  bend 
*/ 

pushmatrixQ; 

temp  =  Bendradiusl  -  Roadwidth/2  -f-  Roadlen; 

translate(temp,  0.0,  -Roadlen); 

rotate(-900,  ’X’); 

rotate(-900,  ’Z’); 

bend(); 

popmatrixQ; 

/* 


121 


Build  2nd  right  turn  signboard 


*  / 


pushmatrix(); 

translate(temp  -  Roadwidth.  0.0,  -Roadlen  -  Bendradiusl); 

rotate(-900,’Y’); 

signb(1.9,  2.5,  3.0,  signbg); 

popmatrix(); 

pushmatrL\(); 

translate) temp  -  Roadwidth.  4.0.  -Roadlen  -  Bendradiusl  -  0. 

rotate(-900.’Y?); 

rotate(-900 .  ’  Z  ’ ) ; 

polyarrow(0.7.  1.2.  0.0,  nghtsign); 
popmatrix(); 


THIRD  STRETCH  OF  RO\D 


pusnmatrixt ); 

temp  =  2  *  3enaradiusl  -  Roaawmtn  —  Roaaien: 
transiate|temp.  0.0.  0.0): 

surf(0.0,  0.0,  0.0,  Roadwidth,  Roadlen,  BLACK): 
popmatrix(); 


Create  a  series  of  arrows 


*  / 


for  (i  =  Roadlen;  i  >  5.0;  i  -  =  20.0) 

{ 

pushmatrix(); 

translate(temp,  0.0.  -i); 

rotate  (-900, ’X’): 

rotate(-1800,  ’Z’); 

polyarrow(0.7,  1.2,  0.0,  WHITE); 

popmatrix(); 

} 


r 

Create  4nd  uparrow  signboard 
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pushmatrix(); 

translate(temp  —  Roadwidth.  0.0,  -Roadlen  -f  10.0); 

rotate(-1800,’Y’); 

signb(1.9,  2.5,  3.0,  signbg); 

popmatrix(); 

pushmatrix(); 

translate(temp  —  Roadwidth,  high,  -Roadlen  -7  10.0); 

rotate(-1800,’Y’); 

polyarrow(0.7,  1.2,  0.0,  upsign); 

popmatrix(); 


Third  road  bend 

*  / 

/ 

pushmatrix(); 

temp  —  Bendraaiusi  -  Roadwidth  2  —  Roadlen: 

translate! temp.  0.0.  0.0); 

rocate|-900.  X'); 

rotacei-1800.  ’Z'); 

bend( ); 

popmatrix(); 


if:**;**:;**;:*:.*.*.*::? 


FOURTH  STRETCH  OF  ROAD 


******************************** 


pushmatrixQ; 

temp  =  Bendradiusl  -  Roadwidth/2: 
translate(temp,  0.0,  temp); 
rotate(-900,  ’Y*); 

surf(0.0,  0.0,  0.0,  Roadwidth,  Roadlen,  BLACK); 
popmatrix() ; 

/* 

Create  a  series  of  arrows 


7 

for  (i  =  temp  -r  10.0;  i  <  temp  +  Roadlen;  i  +=  20.0) 

{ 

pushmatrix(); 
translate(i,  0.0,  temp); 
rotatel-OOOZX’); 
rotate(900,’Z’): 

polyarrow(0.7,  1.2.  0.0,  WHITE); 
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popmatrix(); 

} 


Create  5nd  uparrow  signboard 


pushmatrix() ; 

translateiRoadlen,  0.0,  Bendradiusl  —  2.0); 

rotate(-2700,’Y’); 

signb(1.9,  2.5.  3.0,  signbg); 

popmatrix(); 

pushmatrix() ; 

translate(Roadlen,  high.  Bendradiusl  —  2.0): 
rotate(-2700.,Y’): 
polyarrow(0.7.  1.2.  0.0,  upsign): 
popmatrix(): 


MSTOPff  sign  Derore  me  °na  of  circuit 


temp  —  1.5  *  Bendradiusl: 
color(  WHITE); 
pushmatrix(): 
translate(temp.  0.0.  70.0); 
rotate(900,’Y’); 
rotate(-900,’X’); 
letter(’P\  BLACK); 
popmatrix(); 

color(  WHITE); 

pushmatrix(); 

translate(temp,  0.0,  75.0); 

rotate(900,’Y’); 

rotate(-900,’X’); 

letter(’0\  BLACK); 

popmatrix(); 

color(  WHITE); 

pushmatrix(); 

translate(temp,  0.0.  80.0); 

rotate(900,’Y’); 

rotate(-900,’X’); 

letter(’T’,  BLACK); 

popmatrix(); 

color(  WHITE); 
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pushmatrix(); 
translate(temp,  0.0,  84.0); 
rotate(900,’Y’); 
rotate(-900,’X’); 
letter(’S\  BLACK); 
popmatrix(); 

popviewport(); 

popmatrix(); 

closeobj(); 

}  /*  maKetheroad 


C.  Integrate. c 


/* 

Runge-Kutta  2nd  order  or  Euler-Heun  numerical  integration 


*  / 


^include  "road.h" 

extern  float  heading  angle  rate  gain,  velocity  time  consant: 
extern  float  turning  response  gain,  heading  angle  gain: 
extern  float  steer  wheel  angle,  speed,  state  vector  5i; 
extern  float  car  time,  deltat,  cmd  psi  dot: 


'  *  *  *  X  X  *  X 


NTSGR 


I  o  X 


.'•omouce  new  statei  autop  i 
Boolean  autop: 


float  xcap  5  .  xaot  5  : 
int  i; 

derivative(state  vector,  xdot,  autop): 

for  (i  =  1:  i  <=  SYSTEM_ORDER;  — i-i) 

/*  Euler  prediction  * 

xcapti  =  state  vector  l  —  xdot  i  *  deltat; 

car  time  =  car  time  —  deltat; 
derivative(xcap.  xdot,  autop); 
for  (i  =  1;  i  <  =  SYSTEM  ORDER;  —hi) 

/*  Trapezodial  correction  */ 
state  vectorjij  =  (statejvectori  —  xdot  i 
*  deltat  -r  xcap  i] ) / 2.0; 

}  /*  compute  new  state  */ 

/***********************************:»:************************* 


DERIVATIVE 


******************************************** 


**************** 


/ 


derivativefwork  vector,  xdot.  autop) 

Boolean  autop, 

float  work  _vec  tor  ,  xdot [); 
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{ 


xdot[l  =  cos(work_vector[4])  *  work_vector  3] ; 
xdot!2,  =  sin(work_vector'4])  *  work_vector[3;; 

if  (!autop) 

xdot[3]  =  -  (l/velocitv_time_consant)  *  work_vectorj3j 
-+■  (1/velocity  time_consant)  *  speed; 

else 

xdot!3l  =  0;  /*  no  acceleration  for  autopilot  5,1 
if  (lautop) 

xdoti4l  =  turning _response_gain  *  work_vector  3 
*  steer_wheel_angle; 

else 

{ 

xdot,4  =  cmd_psi_dot; 

i 

( 

}  *  derivative  * 
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D.  Display. c 


This  module  generates  all  the  vehicle  dashboard  indicators. 

1.  Speedometer 

2.  Odometer 

3.  Compass 

4.  Fuel  Meter 

5.  Help  Panel 

6.  Warning  Panel 

7.  Steering  Wheel  Display 

Some  of  the  ideas  here  were  adopted  from  fltsim.c. 


^include  ,?road.hM 


extern  Coord  latri  3!  2:.  ratri  3  2 

extern  Tag  transl,  transl‘2.  transiC.  transit.  trans22.  fuell: 
extern  Tag  odotagl  oaotag2.  odotag3.  odotag4.  steerwheeltag; 
extern  Tag  dangertag.  temDtag,  beittag,  braketag,  transil: 
extern  boat  neading  xdos: 


SPEEDOMETER 


makethespeedometer  (speedometer) 

Object  '’'speedometer; 

{ 

lcoord  charxpos,  posl.  pos2,  tempx,  tempy; 
Object  meter, meternum; 

posl  =  467;  pos2  —  150; 
tempx  =  posl  4-  90; 
tempy  -  pos2  4-  80; 
charxpos  =  posl  —  30; 

/*  Generate  outline  for  speedometer  dial  * 


meter=genobj(); 
makeobj  (meter); 


128 


color(BLACK); 


rectfi(posl,  pos2,  tempx.  tempy); 
color(  WHITE); 

rectfi(posl  +  10,  pos24-10.  tempx-10,  tempy-10) 
color(BLACK); 


cmov2i(posl,pos2-15); 
charstr(n  km/hr  M): 

latriiOj  [0|=posl; 
latri  [0  j !  1  =  190-9: 


latri  l!  0i  =  posl  —  25: 
iatn  1  i  li  =  190; 


iatrii2!!0l=posi: 
latrii2!  i i  =  L90— 9: 

poif2(  3.iatri] : 

ratrii0li0i  =  temDx: 
ratriiOl!  I!  =  190-9: 


ratni  i|j0|=tempx; 

ratri[  1  j  [  1  j  =  190 —  9; 

ratri,2][0]  =  tempx-25; 
ratri[2j[l  i  =  190; 
polf2(3,ratri); 

closeobj(); 

/*  Generate  number  in  speedometer  display 

meternum=genobj(); 

makeobj(meternum); 

color(BLACK); 

cmov2i(charxpos,000); 

charstr("000"); 

cmov2i(charxpos,030); 

charstr(!,010rt); 

cmov2i(charxpos,060); 

charstr(,T020M); 

cmov2i(charxpos,090); 

charstr(n030M); 

cmov2i(charxpos,100); 


charstr(,T040n); 

cmov2i(charxpos,125); 

charstr(t,050,t); 

cmov2i(charxpos,150); 

charstr(M060M): 

cmov2i(charxpos,175); 

charstr(n070,f); 

cmov2i(charxpos,200); 

charstr(n080,f); 

cmov2i(charxpos.225): 

charstrj  M090n); 

cmov2i(cnarxpos.250): 

charstri M 100” ) ; 

cmov2i(cnarxpos.2T5); 

charstr(nllOM); 

cmov2i(charxpos.300); 

:harscr(  n120M): 
c  m  o  v  2  i  t  c  n  arx  Dos .  3  2  5  ) : 
charstrt  "  130!f ' ; 
r  mo  v  2  i  ( c  n  arx  dos  .350); 

narstr:  !’I40:M; 
v  m  ov  2  i  i  c  n  arxpos .  3  7  5 ) ; 
onarstn  "ISO”): 
cmov2iicnarxDOs.400); 
rnarstrt  f,160'M; 
mov2i(cnarxDos.  V25) : 
charstrl  "170"): 
cmov2i(charxpos,450): 
charstr(T1 180n); 
cmov2i(charxpos,475); 
charstr("190M); 

closeobj(); 

/*  Put  all  pieces  of  speedometer  together 


*speedometer=genobj(); 
makeobj  ( ^speedometer) ; 


/*  Draw  the  boundary  */ 
callobj(meter); 

/*  Draw  the  display  speedometer  in  the  window  */ 

scrmask(charxpos.tempx,pos2-fl0,tempy-10); 

pushmatrix(); 
transl4  =  gentag(); 
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maketag(transl4): 

translate(O.O.O.O.O.O); 

callobj(meternum); 

popmatrix(); 

/*  Reset  screenmask  to  full  size  screen  * 
scrmask  (0,1023,0, 767); 

viewport(  0,1023,0. 767); 

closeobjQ; 

}  /*  makethespeedometer  * 

/***xx****x****xx*  **x*xx***xx*»****x 


FUEL  METER 


xxx*XXX5kxxxxxx:**xxxxxxxxxxxxxxxxxXXx 


makefuel(fuei) 

Object  *fuei: 

/ 

i 

Coord  fuelxl,  fueLx2,  fuelyl,  fuely2; 
Object  fuelbound.fuellevel; 

fuelxl  =  102.0:  fuelx2  =  fuelxl  +  51.0; 
fuelyl  =  10.0;  fuelv2  =  340.0; 

/*  Generate  outline  for  fuel  indicator  * 

fuelbound=genobj(): 

makeobj(fuelbound); 

color(BLACK); 

rectf(fuelxl,  fuelyl,  fuelx2,  fuely2); 


cmov2(  107.0,345.0); 
charstr(MfuelM): 

/*  Generate  hash  marks  for  fuel  levels  */ 
linewidth(3); 

move(fuelx2.  fuely2-30.0,  0.0); 
rdr(5.0.  0.0.  0.0): 


/*  cmov2(fuelx2  — 6.0,  fuely2-35.0); 
charstr(”  Full”);  */ 

move(fuelx2,  fuelyl^60.0,  0.0); 
rdr(5.0,  0.0,  0.0); 

/*  cmov2(fuelx2— 6.0,  fuelyl-f-55.0); 
charstr(”  Empty”);  */ 

linewidth(l); 

closeobj(); 

*  Generate  the  fuel  level  bar  that  moves 

fuellevel=genobj(); 

makeobj(fuellevel); 


color  (WHITE); 

rectf(fuelxl — 4.0.  fueivl  —  4.0.  fuelx2-4.0,  fueiy2-4.0); 


closeobj(); 


Put  ail  pieces  of  fuel  together  * 

*fuel=genobj( ) ; 
makeobj(*fuel); 
callobj(fuelbound); 

callobj(fuellevel); 
color  (YELLOW); 

fuell  =  gentag(); 
maketag(fuell): 

rectf(fuelxl-r4.0,  fuelyl-4.0,  fuelx2-4.0.  fuely2-4.0); 
color(BLACK); 

closeobj(); 

}  /*  makefuel  */ 


HELP  PANEL 


*************************************************************/ 


makehelp(help) 
Object  *help; 
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{ 


*help=genobj(); 

makeobj(*help); 

color(BLACK): 


rectfi(10,10,90.340); 

coiorf  WHITE): 

rectfi(  15,15.85.335); 

color(BL  ACK): 

/*  Generate  info  on  disolay 

linewidtht  2); 

cmov’Jif  10.545); 
charsrrt"  :ieiD  ,T): 

cmov'Jii  35.515 1 : 
charstri "  Exit11); 

:oiori  RED ) : 
circii(  29. 500.6); 
circfi(50.300,6); 
circfi(71,300,6); 

color(BLACK); 
cmov2i(217275); 
charstr("  Speed  M); 
circi(  29,260,6) ; 
circi(50.260,6); 
color(RED); 
circfi  ( 7 1 , 260,6) ; 

color(BLACK); 

cmov2i(21,235); 

charstr(M  Brake”); 

color(BLACK): 

circi(29,220,6); 

color(RED); 

circfi  (50,220,6); 

color(BLACK); 

circi(71,220,6); 

cmov2i(21,195); 
charstr("  Stop"); 
color(RED); 
circfi(  29, 180,6); 
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color(BLACK); 
circi(50, 180.6); 
circi(71,180,6); 

cmov2i(  10,1 15); 
charstr(M  Press  ,f); 
cmov2i(  10,95); 
charstr(**  h  **); 
cmov2i(  10,75); 
charstrf"  for  M): 
color(RED); 
cmov2i(  10.55); 
charstrf M  HELPM); 


cmov2i(21.135); 
charstri rt  Brake'*): 
:irci(29. 120.6): 
colon  RED) : 
circn(50.120.6i: 
coiori  BLACK): 
circii  71.120.6)- 

cmov2if  32.95): 
-riarscrt  f?STOPM ' • 
'oiori  BLACK  i . 
circi(29,30.6); 
color(RED); 
circfi  (50.80,6); 
circ  fi(7 1,80,6) ; 


color(BLACK); 
closeobj() : 

}  /*  makehelp  * 


/*********************************************,;*************** 


ODOMETER 


*******************************x**************************1:** 


maketheodome  ter  (odometer) 

Object  *odometer; 

{ 

lcoord  posl,  pos2,  tempx,  tempy; 

Coord  temp,  charx,  char)’; 

posl  =  467;  pos2  =  50; 

tempx  =  posl  H-  90;  tempy  =  pos2  4-  50; 
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*odometer  —  genobj(); 
makeobj(*odometer); 

color(BLACK); 

rectfi(posl,  pos2,  tempx,  tempy); 
color  (WHITE); 

rectfi(posl4- 5,  pos2+5,  tempx-5,  tempy-5); 
color(BLACK); 

temp  =  (tempx  -  posl  -  10)/4; 
move2(posl45+temp,  pos2  —  5): 
draw 2 (posl  — 5  — temp,  tempy-5); 

move2(posl^54temp*2,  pos2^-5); 
draw  2  (pos  1-^5— temp*2,  tempy-5); 

move2(posl^5^temp*3.  pos2  —  5); 
draw2(posl  — S^temp*’!.  tempy-5); 

mo ve2  ( pos  1 — 5 —temp  *  4 ,  pos‘2  —  5 ) : 
draw2(posi  — 5— ternp^,  tempy-5); 

charx  =  posl  — 5— temp/ 2:  chary  =  (tempy-pos2)  2  —  pos2-5.0: 

cmov2(cnarx.  chary); 
odotagl  —  gentag(); 
maketag(odotagl); 
charstr(”0”); 

cmov2(charx  4-  temp,  chary); 
odotag2  =  gentag(); 
maketag(odotag2); 
charstr(n0M); 

cmov2(charx  4  temp*2,  chary); 
odotagS  —  gentag(); 
maketag(odotag3); 
charstr(”0”); 

cmov2(charx  4  temp*3,  chary); 
odotag4  =  gentag(); 
maketag(odotag4); 
charstr(MOn); 

color(BLACK); 
cmov2i(posl,pos2-15); 
charstr(”  meter”): 
closeobj(); 

}  /*  maketheodometer  */ 
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WARNING  PANEL 


************************************************************* / 

/ 


makewarning  (warning) 

Object  *warning; 

{ 

Coord  tempx,  tempy,  posl,  pos2; 

Coord  ix,  iy.  tempy  1,  tempy‘2,  tempv3,  tempv4,  hg: 

posl  =  840.0;  pos2  =  10.0; 

tempx  =  posl  n-  140.0;  tempy  =  340.0; 

iy  =  ix  =  20.0; 

*  warning  =  genobj(); 
m  akeobj  ( *  w  arnin  g ) : 

color(  BLACK): 

rectfjposl.  pos2.  tempx.  tempy): 
hg  —  (330  -  5xiv)  4; 

oangertag  =  gentagi); 

maketagjdangertag): 

color(RED^: 

rectffpos  i  —  ix.  pos2  — iy.  cemox-ix.  pos2 -iy -hg): 
coior(BLACK) ; 

cmov2(posl  -h  ( tempx-posl) /2  -  25.0,  pos2+iy  +  hg/2-5.0); 
charstr(M  Danger”); 

temptag  =  gentag(); 
maketag(temptag); 
color(RED) ; 

rectf(posl+ix,pos2-riy*2-rhg,tempx-ix,pos2-+-iy*2+2*hg); 

color(BLACK); 

cmov2(posl  —  (tempx-posl) /2  -  12.0,  pos2-t-iy *2-rhg-{-hg/2-5.0); 
charstr(”Temp”); 

belttag  =  gentag(); 

maketag(belttag); 

color(RED); 

rectf(posl-rix,pos2  —  iy*3— hg*2,tempx-ix,pos2-{-iy*3  +  3*hg); 
color(BLACK); 

cmov2(posl  *r-  (tempx-posl ) /2  -  40.0,  pos2-f iy*3~  hg*2-rhg/2-5.0); 
charstr(”Seat  Belt”); 

braketag  =  gentag(): 

maketag(braketag); 

color(RED); 

rectf(posl-f  ix,pos2-riy*4-f  hg*  3,tempx-ix,pos2-biy*4-j-4*hg); 
color(BLACK): 

cmov2(posl  -t  (tempx-posl) '2  -  17.0,  pos2i-iy*4  +  hg*3-^hg/ 2-5.0); 
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charstr("Brake,f); 

color(BLACK); 

cmov2(posl+20.0,  tempy-r5.0); 
charstr(n  Warning11); 

closeobj(); 

}  /*  makewarning  */ 


l**^****»*^j(**x***x***!t:*******xx**x*x******>x***************x 


STEERING  WHEEL 


jf.*-3f:.3li**X*^:m**i^*^i^^^if^*-x-x^:*x^^X-x 


xxxxxxxx:*;fc:»:x-«::»:xxxx 


makesteerwheelfsceerwheei) 

Object  *5teerwneei; 

i 

„  *steerwheei  =  genooj(): 
maKeopjj’Cteerwtieei); 

pushmacnx() ; 
color!  BLACK); 
circnf512.  290.  40); 
color!  WHITE): 
circfi(512,  290,  30); 
color(BLACK); 

translate(512.0,  290.0,  0.0); 
steerwheeltag  =  gentagQ; 
make  tag  (steerwheeltag); 
rotate(0,  ’Z’); 
rectfi(-33,  -5,  33,  5); 

popmatrix(); 

closeobjQ; 

}  /*  makesteerwheel  */ 

^********************************^*****^**^*^^^  ************  **^ 


HEADING  METER 


*************************************************************  j 

i 


makeheading(heading  meter) 
Object  ^heading  meter; 

{ 
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Object  meter,  theading: 

Coord  posl,  pos2,  tempx.  tempy; 
posl  =  heading_xpos;  pos2  =  350.0; 
tempx  =  posl  -f  175.0: 
tempy  =  pos2  —  12.5; 

meter  =  genobjQ; 

makeobj(meter); 

color(BLACK); 

rectf(posl-2.5,  pos2-2.5.  tempx-r-2.5.  tempy— 2.5); 
coior(  WHITE); 

rectf(posl.  pos2.  tempx.  t^mDv); 
closeobj(): 

*  Generate  the  heading  on  top  of  the  terrain  map 


tneading=?enobj( ) ; 
m  ak  eo  bj  ( t  lie  ad  in  g  j : 
color!  BLACK) ; 


cmov  2  ( 000.0.  dos  2-  2 . 0 ) ; 
narstri  n340'M: 

:  m  o  v  2  ( 04  5 .0 .  pos*  2  -  2 . 9 ) : 
cnarstri  M350"); 

cmov  2(  090. 0,pos2-2.0); 
charstr(”360M); 


cmov  2  ( 135.0,  pos2-2.0); 
charstr(n010n); 

cmov  2  ( 180.0,  pos2-2.0); 
charstr("020M); 

cmov2(225.0,pos2-2.0); 

charstr(n030M); 

cmov2(270.0,pos2-2.0); 

charstr("040M); 

cmov2(315.0.pos2-2.0); 

charstr(n050M); 

cmov2(360.0,pos2-2.0); 

charstr(n060n); 

cmov2(405.0,pos2-2.0); 

charstr(M070M); 
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cmov2(450.0,pos2-2.0); 

charstr(n080n); 

cmov2(495.0,pos2-2.0); 

charstr(n090M): 

cmov2(540.0,pos2-2.0); 

charstr(n100"); 

cmov2(585.0,pos2-2.0); 
charstrf"  1 10,r ) ; 

cmov2(630.0.pos2-2.0): 
charstr(M  1 20M ) ; 

cmov2(675.0,pos2-2.0); 

charstr(M130rf); 

cmov2(  720.0.  pos2-2.0); 
charstr(?T140M): 

cmov  2(  765.0.  pos2-2.0); 
charstr( ,f  150'M: 

cmov2(810.0.pos2-2.0): 
cnarstr("  160,M; 

cmov2(855.0,pos2-2.0); 

charstr(n170n); 

cmov2(900.0,pos2-2.0): 

charstr(M180n); 

cmov2(945.0,pos2-2.0); 

charstr(n190n); 

cmov2(990.0,pos2-2.0); 

charstr("200M); 

cmov2(  1035.0,  pos2-2.0): 
charstr(M210n); 

cmov2(l080.0,pos2-2.0); 

charstr(n220n); 

cmov2(1125.0,pos2-2.0); 

charstr(M230M); 

cmov2(ll70.0,pos2-2.0); 

charstr("240M); 

cmov2(1215.0,pos2-2.0); 
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charstr(M250M): 

cmov2(1260.0,pos2-2.0); 

charstr(M260M): 

cmov2(1305.0,pos2-2.0); 

charstr("270,r); 

cmov2(l350.0,pos2-2.0); 

charstr(M280M): 

cmov2(  1395.0, pos2-2.0); 
charstr(M290M); 

cmov2(  1440.0,  pos2-2.0); 
charstr(M300M); 

cmov2(  1485.0.pos2-2.0): 
cnarstrf  r,210"): 

cmov2(  1530.0,pos2-2.0); 
cnarsirf  "320"): 

cmov2(  1575.0.  pos2-2.0): 
cnarstri  "330"): 

cmov2(  1620.0,  pos2-2.0); 
charstr(M340,f): 

cmov2(1665.0,pos2-2.0); 

charstr(M350M); 

cmov2(l710.0,pos2-2.0); 

charstr(M360!1); 

cmov2(1755.0,pos2-2.0); 

charstr(M010,T); 

cmov2(  1800.0,  pos2- 2.0); 
charstr(n020n) ; 

color(BLACK); 

closeobj(); 

/*  Put  all  the  pieces  together 

*heading_meter=genobj(); 
makeobj(*heading  meter); 


/*  Draw  the  boundary  */ 


callobj(meter); 

/*  Draw  the  heading  * / 

scrmask((int)  posl,(int)  tempx,(int)  pos2,(int)  tempy); 

pushmatrix(); 

transll=gentag(); 

maketag(transll): 

translate)  0.0.0. 0.0.0); 

callobj(theadmg); 
scrmask  (0,1023,0.767); 
popmatrix(); 

colon  RED): 
iinewidth(4 1 : 

move2(posi  —  I75.0/2.pos2): 
araw2(posi  — 175.0  2. tempv i : 

iinewidthi  1); 

scrmasK)  0,1025.0.767): 
cioseooj(); 

}  /*  makeheading  */' 
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E.  Other. c 


/* 


This  module  contain  the  supporting  routines  for  building  the 
scenery  objects  like  the  clouds  and  mountains. 

7 

^include  ’’roaa.h” 


extern  Dimension  Roadlen.  Roadwidth,  Bendraaiusi: 

extern  Tag  iKylooktag,  terrainiiooKtag: 

extern  Tag  houselooktag.  housetranstag; 

extern  Tag  housescaletag; 

extern  Tae  houseilooktag.  houseltranstag: 

extern  Tae  house  iscaieiag; 

extern  Angie  Fov 


r\  i 


maKetnesKyisKV ) 

Object  *skv; 

{ 

*skv=  genobj(); 
makeobj(*sky); 

pushmatrixf) : 
pushviewport(); 
viewport(0,  1023,  385,  767); 
setdepth(0,1023); 

perspective(Fov.  1023.0/385.0,  0.0,  1023.0); 

skylooktag  =  gentag(): 

maketag (sky  look  tag); 

lookat(0.0,  0.0,  0.0.  0.0,  0.0,  0.0,  0); 

pushmatrix() ; 

translate(0.0,  100.0,  50000.0); 

surf(0.0,  0.0,  0.0,  100000.0,  100000.0,  SKY); 

popmatrix(); 

popviewport(); 

popmatrix(); 

closeobj(); 

}  /*  makethesky  */ 
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/*****a:********:*:********XS|:**:*:X*****:t:*****:!*:*4::*:***:i::*::*:*:*::*:j*:***:*:*x* 

/ 


CLOUDS  AND  MOUNTAINS 


**********************x*x************************************ 


/ 


maketerrainl  (terrain!.) 

Object  *terrainl; 

{ 

Dimension  temp  =  -(Roadlen+500.0); 
Dimension  tempi  =  -(Roadlen—  500.0); 
Dimension  tempy  =  0.0: 

Dimension  tempyl  =  100.0: 

Dimension  tempv2  =  350.0: 

*terrainl=  genobjQ; 
makeobj(*terrainl); 

Generate  some  clouds  * 

pushmatrix(); 
pusnviewportf): 
viewport(0.  1023.  385,  767); 
setdepth(0.1023); 

perspectivefFov.  1023.0/385.0.  0.0,  1023.0); 
terrain  llooktag=  gentag'J; 
maketagj  terrain  llook  tag); 
lookat(0.0,  0.0,  0.0,  0.0,  0.0,  0.0.  0); 

pushmatrix(); 

co!or(  WHITE); 

translate(-1000.0,  tempyl,  temp); 
scaie(  1.0,  1.0.  1.0); 
rotate(-900,  ’Y’); 
circf(0.0,  0.0,  40.0); 
circf(50.0,  0.0.  30.0); 
circf(40.0,  50.0,  40.0); 
popmatrix(); 

pushmatrix(); 

color(  WHITE): 

translate(-1000.0,  tempyl,  temp); 
scaie(l.0,  0.8,  1.0); 
circf(0.0,  0.0,  40.0); 
circf(50.0,  0.0,  30.0); 
circf(40.0,  50.0,  40.0); 
popmatrix(): 

pushmatrix(); 

color(  WHITE); 

translate(-2000.0,  tempyl,  temp); 
scale(2.0,  2.0,  1.0); 
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rotate(-900.  ’Y’); 
circf(0.0,  O.O,  40.0); 
circf(50.0,  0.0,  30.0); 
circf(40.0,  50.0,  40.0); 
popmatrix(); 

pushmatrix(); 
color)  WHITE); 

translate(-2000.0,  tempvl.  temp) 
scale(2.0,  0.8,  1.0); 
circf(0.0,  0.0,  40.0); 
circf(50.0.  0.0,  30.0): 
circf(40.0,  50.0.  40.0); 
popmatrix(); 

pushmatnx(): 
color)  WHITE): 

translate) 2000.0.  tempvl.  temp): 
scale(3.0.  2.0.  1.0): 
rotatei-900.  ’Y'): 
circf(0.0.  0.0.  40.0); 
circf{50.0.  0.0.  30.01: 
circfl'40.0.  50.0.  40.0): 
popmatrix)  ): 

pushmatrix) ): 
color)  WHITE): 

translate(2000.0.  tempvl,  temp); 
scale(2.0,  0.8,  1.0); 
circf(0.0,  0.0.  40.0); 
circf(50.0.  0.0,  30.0): 
circf(40.0,  50.0.  40.0); 
popmatrix(): 

/*  Generate  some  mountains  * 
pushmatrix)): 

translate(-2000.0,  tempy,  temp); 
scale  (1.0.  0.1,  0.0); 
color)  MOUNTAIN  1 ): 
arcffO.O.  0.0.  400.0.  0,  1800); 
popmatrix)); 

pushmatrix)); 

translate(-1500.0,  tempy,  temp); 
scale  (1.0,  0.2,  0.0); 
color)  MOUNTAIN); 
arcf(0.0,  0.0,  250.0,  0,  1800); 
popmatrix)); 

pushmatrix)); 

translate(-1000.0,  tempy,  temp); 


scale  (1.0,  0.1.  0.0); 
color(MOUNTAlNl); 
arcf(0.0,  0.0,  300.0,  0,  1800); 
popmatrix(); 

pushmatrixQ; 

translate(  1000.0,  tempy,  temp): 
scale  (1.0,  0.2,  0.0); 
color(MOUNTAIN); 
arcf(0.0,  0.0.  250.0,  0,  1800): 
popmatrix(); 

pushmatrLx(); 

translate)  1500.0.  tempy.  temp): 
scale  (1.0,  0.1,  0.0): 
color  (MOUNT  A  INI); 
arcf(0.0.  0.0.  300.0,  0.  1800): 
poomatrix(): 

Dusnmatnxl ); 

translate!  2000.0.  tempy.  temp): 
scale  (1.0.  0.1.  0.01: 
coior  i  MO  UNT  AIN  l ) ; 
arcffO.O.  0.0.  300.0.  0.  1800): 
popmatrix(); 

popviewport(): 

popmatrix(); 

closeobj(); 

}  /*  maketerrainl*/ 


BUILD  SURFACES 


**********************:«***:*****;***** 


surf(x,  y,  z,  width,  length,  roadcolor) 
Coord  x,  y,  z; 

Dimension  width,  length; 

Colorindex  roadcolor; 

{ 

Coord  vertice[5][3j; 

Dimension  temp; 
temp  =  width/2; 

vertice[0][0]  =  x; 
vertice[0/l  =  y; 
vertice[0j[2  =  z; 

verticejlUO  =  x  -  temp; 
vertice[lj[l  =  y; 


vertice(l][2 

vertice[2  0 
vertice,  2  li 
vertice^,  ;2 

vertice[3^  |0 
vertice[3j[l 
vertice[3  2 

vertice  4  0 
vertice|4  1 
vertices;  2 


=  z: 

=  x  -  temp: 
=  v; 

—  -length; 

=  x  —  temp; 

=  y; 

=  -length: 

=  x  -r  temp: 

=  z: 


color(roadcolor); 

polf(5.vercice); 

}  *  surf  * 


BUILD  ROAD  BENDS 


bend! ) 

coior\3L  ACK): 

arcfi(0,  0,  (int)  Bendradiusl,  900,  1800); 
color(FIELD); 

arcfi(0,  0,  (int)  (Bendradiusl  -  Roadwidth),  900,  1800); 

} 


BUILD  SIGNBOARD 


signb(width.  length,  height,  bcolor) 

Dimension  width,  length,  height: 

Colorindex  bcolor: 

{ 

Coord  vertice  5i  3  ; 

Coord  verticel  5] [3] ; 

Dimension  legwidth,  tempi,  temp2,  tempo; 
legwidth  =  0.2;  /*  size  of  supporting  leg  */ 

tempi  =  length/2; 
temp2  =  length/4; 
temp3  =  legwidth /2; 


verticeJOj  0  =  0.0; 
verticejO’  1  =  height; 
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vertice[0][2j  =  0.0; 


vertice[l][0  =  -tempi; 
vertice[l]jl  =  height; 
vertice[l][2j  =  0.0; 

vertice|2](0:  =  -tempi; 
vertice[2][l!  =  width  -r  height; 
vertice[2][2j  =  0.0; 

vertice  3](0  =  tempi; 
vertice  3ul  =  width  -f  height: 
vertice!3j!2  =  0.0; 

vertice[4l  0  =  tempi: 
vertice|4(  1  =  height: 
vertice(4i  2  =  0.0: 


coior(bcolor): 
polf(  5.  vertice): 


x  Generate  tne  supporting  ieg 
verticellOiiO'  =  0.0: 
verticellOKl  =  0.0: 
verticeliOl 1 2'  -  0.0; 

verticel  1,  Oj  =  -temp3; 
vertice  1  f  1  ]  [  1  ]  =  0.0: 
verticel]  l]  [2]  =  0.0: 

verticel[2][0]  =  -tempo; 
verticel[2][lj  =  height; 
verticel}2]!2]  =  0.0; 

* 

verticel  [3]  [0]  =  temp3; 
verticel[3]jl)  =  height; 
verticel  r3]  [2,  =  0.0; 

verticel  4]|0]  =  temp3; 
verticel  [4] !  1  =0.0; 
verticel[4]f2  =  0.0; 

color(BLACK); 
polf(5, verticel); 

}  /*  signboard  */ 

/************************************************************* 

BUILD  ARROW 


************************************4:************************  / 
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polyarrow(bodvwidth,  headwidth,  high,  arrowcolor) 
Colorindex  arrowcolor; 

Dimension  bodvwidth,  headwidth,  high: 

{ 

Coord  verticei 5][3|,  verticell3j  3  ; 

Dimension  bodyheight  =  0.8; 

Dimension  headheight  =  1.5; 

Dimension  tempi  =  bodvwidth/2; 

Dimension  temp2  =  headwidth/2; 


verticeOj'Oi  =  0.0: 
verticejO)  lj  =  0.0  —  high: 
vertice[0  21  =  0.0: 


verticejl]  jOj  =  -tempi: 
vertice'l  1  =  0.0  —  high; 
verticei  1  2'  =  0.0; 


vertice  T  0 
vertice' 2  1 
verticei-  21 


-tempi; 

bodyheight  —  high: 

0.0; 


verticei!  Oi 
verticeiS  1 
verticeiu  2! 


temp  l: 
bodyheight 


0.0; 


high; 


vertice  i  0; 
vertice  4  1 
verticeU1  21 


tempi; 

0.0  -+-  high: 

0.0; 


color  (arrowcolor): 
polf(5, vertice); 

verticei  0'  0  =  -temp2; 

verticei  0  1  =  bodyheight  +  high 

verticei  0]  2  =  0.0; 

verticei  lj  0  =  0.0; 

verticei  ljil  =  headheight  4-  high; 

verticei  1  j  [  2  =  0.0; 

verticei  2  0=  temp2; 

verticei  2]  1  =  bodyheight  +  high; 

verticelf2][2  =  0.0; 

color(  arrowcolor) ; 
polf(3, verticei); 

}  /*  polyarrow  */ 


* 


/*****3|c***:**************x*******:************!k*****:*******x*:*** 


BUILD  HOUSE 


148 


*****************  ******************************************** 


/ 


makehousef  house) 

Object  *house: 

{ 

float  sidewalll5][2i,  roof[4  2..  chmwalll:4  ^2j; 
float  chmwall2j4][2],  sideroofl4  '2  ; 

*house=genobj(); 

makeobj(*house); 

pushmacrixi ); 
pushviewporcf); 
viewport (0.  1023,  385.  767); 
setdepth(0.l023); 

perspective(Fov.  1023. 0/385.0.  0.0.  1023.0); 
houselooktag  =  gentagf); 
m  ak  e  r  ag  ( ho  u  s  e  ioo  k  i  ag ; : 
iooKatiO.O.  0.0  0.0.  0.0.  0.0.  0.0.  0): 

pushmacrixi ): 
nousetranstag  —  genragi); 
maKetagjhousetranstag j : 
translated. 0.  0.0.  0.0); 
housescaiecag  —  gentagj): 
maKerag(  hcmseseaieragj; 
scale!  i.O,  1.0.  1.0): 

/*  Draw  front  wall  */ 

color(WALL); 
rectf(-1.0, 0.0, 16. 0,10.0); 

/*  Draw  side  wall  * 

sidewall|0j[0j  =  (-4.0); 
sidewalljO]  [  l]  =  (2.0) ; 
sidewall  jl][0]  =  (0.0); 
sidewalljl][l]  =  (0.0); 
sidewall  [2]  [0]  =  (0.0); 
sidewall[2][ll  =  (10.0); 
sidewall[3][0i  =  (-3.0); 
sidewall  [3]  [  1  j  =  ( 1 3 .0) ; 
sidewall[4][0]  =  (-4.0); 
sidewall  [4]  [  1  j  =  ( 1 1 . 5 ) ; 

color(  SIDEWALL); 
polf2(5,sidewall); 

/*  Draw  roof  and  sideroof  */ 

roofj0][0]  =  (-1.0); 
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roof[0][l]  =  (10.0); 
roof[l]jo]  =  (l7.0); 
roof*  l][l]  =  (lO.O); 
roof  j  2][0|  =  {l4.0); 
roof  2j;lj  =  (l3.5); 
roofi3][0]  =  (-3.0): 
roof  3][l]  =  (l3.5); 

color(ROOF); 

polf2(4.roon: 

sideroofl  0  i  i  0  =  ( -4 . 3 ) : 
sideroofiOl  1  =(11.5): 
sideroof  1  0  =(-4.0): 
sideroof  1  1  =(  11.5); 
sideroof  2!  0 .  =  (-*2.8): 
sideroof  2:  1  =(  13.1 1: 
sideroof! 3 1  01  =  >-3.0): 
sideroof  3!  1  =(  13.5): 

color!  SIDEROOF): 
poif2(  4. sideroofl: 

Draw  window 


^olori  WINDOW f 
rectf(2. 0.4. 0,5.0, 7.0); 
rectfj  9. 0,4. 0,12.0,7.0), 


/*  Draw  window'  frames  */ 

color  (FRAME); 
linewidth(4); 
move(2. 0,4. 0,0.0); 
draw(5. 0,4. 0.0.0); 
draw(5. 0,7. 0,0.0); 
draw(2. 0,7. 0,0.0); 
draw(2. 0,4. 0,0.0); 
move(3.5,4.0,0.0); 
draw(3.5,7.0.0.0); 
move(2.0,5.5,0.0); 
draw(5.0,5.5,0.0); 

move(9. 0,4. 0,0.0); 
draw(  12.0,4.0.0.0); 
draw(  12.0,7.0.0.0); 
draw(9. 0,7. 0,0.0); 
draw(9. 0,4. 0,0.0); 
move)  10.5,4.0,0.0); 
draw(  10.5,7.0,0.0); 
move(9.0,5.5,0.0); 
draw(12.0,5.5.0.0); 
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/*  Draw  chimney  front  wall  */ 


color  (SIDE  WALL); 
rectf(  1.0,12.0,3.0,14.2); 

/*  Draw  the  hole  on  the  chimney  */ 

color(BLACK); 
rectf(  1.5,13.3,2.5.13.8); 

/*  Draw  top  and  side  walls  of  the  chimney  * 

chmwalll[0  01=0.5: 
chmwallljOj  1=12.5; 
chmwalll  11(01  =  1.0; 
chmwalll  1  1=12.0; 
chmwalll  2  0  =1.0: 
chmwalll  2  11  =  14.2: 
chmwaill.3  0  =0.5. 
chmwall!;3'  1  =14.7: 

colon  CHMW  ALLl ) : 
polf2( 4.  chmwalll): 

chmwall210  0  =2.5: 
chmwall210  1=14.7 
chmwall2|l  0  =3.0: 
chmwall2  1  j  j  1  j  =  1 4 . 2 ; 
chmwall2  2! [0]  =  1.0; 
chmwall2[2l[lj  =  14.2; 
chmwall2,3  0  =0.5; 
chmwall2^3  [1=14.7; 

color(CHMWALL2); 

polf2(4,chmwall2); 

popmatrix(): 

popviewport(); 

popmatrix(); 

closeobj(); 

}  /*  makehouse  */ 

makehousel  (house  1) 

Object  *housel; 

{ 

float  sidewall[5] [ 2  ,  roof(4  [2 j ,  chmwalll  4 j [2] 
float  chmwall2[4][2j,  sideroof(4] [ 2] ; 

*housel=genobj(); 
makeobj(*  house  l); 


pushmatrix(); 


pushviewport(); 
viewport(0,  1023,  385,  767); 
setdepth(0, 1023): 

perspective(Fov,  1023.0/385.0.  0.0,  1023.0) 
housellooktag  =  gentag(); 
m  aket  ag  (house  llook  tag); 
lookat(0.0,  0.0,  0.0,  0.0,  0.0.  0.0,  0); 

pushmatrix(); 
houseltranstag  =  gentag(); 
m  aket  ag  ( house  ltranstag); 
translatefO.O,  0.0,  0.0): 
houselscaletag  =  gentagQ; 
maketag(houselscaletag): 
scale(l.0,  1.0,  1.0); 

*  Draw  front  wall  * 

color(  WALLl ): 
rectfi- 1.0. 0.0. 16.0.10.0): 


Draw  side  wail 


sidewall1 01 1  O' =  (-4.0) : 
sidewall  01  li  — (2.0): 
sidewall  1  i , Of  -(0.0): 
sidewall  1  1  =(0.0): 

sidewall  2  oj  =  (0.0): 
sidewall  2  lj  =  (10.0); 
sidewall  3j i oj  =  (-3.0); 
sidewall[3][l]  =  (13.0); 
sidewall  4j[0)  =  (-4.0): 
sidew'all[4j|l)  =  (  11.5); 

color(SIDEWALLl): 

polf2(5, sidewall); 

/*  Draw  roof  and  sideroof  */ 

roof[0][0]  =  (-1.0); 
rooF[0]  [  1 !  =  ( 10.0 ) : 
roof[ l]  0j  =  (  17.0) ; 
roof[lj[l]  =  (10.0); 
roof[2][oj  =  (  14.0); 
roof[2][l]  =  (13.5); 
roof[3][0]  =  (-3.0); 
roof[  3]  [  1  ]  =  ( 1 3 . 5 ) ; 

color(ROOFl); 

polf2(4,roof); 


sideroof[0][0j  =  (-4.3); 


sideroof‘0][l  —(11.5); 
sideroofjl]  [0  =(-4.0): 
sideroofjl]  jl  =(11.5); 
sideroofj2j  0  =(-2.8): 
sideroof}2]jl  =  (13.1): 
sideroof  3]  [0  =(-3.0): 
sideroof  j  3]  |l  '  =  (13.5); 

color(SIDEROOF); 

polf2(4.sideroof); 

*  Draw  window 

color!  WINDOW): 
rectff  2.0.4. 0.5.0. 7.0): 
rectfl  9.0,4.0.12.0,7.0): 

*  Draw  window  frame> 

coiori  FRAME) : 
iinewiaiht  4): 
movei  2. 0.4. 0.0.0): 
drawi  5. 0.4. 0.0.0); 
draw!  5. 0.7. 0.0.0): 
drawl  2. 0.7. 0.0.0); 
irawi  2. 0.4. 0.0.0) : 
move(3.5.4.0.0.0); 
draw(3.5.7.0.0.0); 
move(2.0,5.5.0.0); 
draw(5.0.5.5,0.0); 

move(9. 0,4. 0.0.0): 
draw(12. 0,4. 0,0.0); 
draw(l2. 0,7. 0,0.0); 
draw(9. 0,7. 0,0.0); 
draw(9. 0.4. 0.0.0); 
move(10.5.4.0,0.0); 
draw(l0.5,7.0,0.0); 
move(9.0,5.5,0.0); 
draw(12.0,5.5,0.0): 

/*  Draw  chimney  front  wall  * / 

color(SIDEWr  ALLl); 

rectf(1.0,12.0,3.0,14.2); 

/*  Draw  the  hole  on  the  chimney  */ 

color(BLACK); 

rectff  1.5,13.3,2.5,13.8); 

/*  Draw  top  and  side  walls  of  the  chimne>  */ 
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chmwalll[0][0  =0.5; 
chmwalll[oj[l  =12.5; 
chmwalll 1  l/O  =1.0; 
chmwallljl '[li  =  12.0; 
chmwalll[2l  [0  =1.0; 
chmwalll[2j[l'  =  14.2; 
chmwalll  1 3]  [0i=0.5; 
chmwalll[3][l  =14.7; 

color(CHMWALLl); 

polf2(4.chmwalll); 


chmwall2!0i  0'  =  2.5: 


chmwall2  0!  1  =  14.7; 


chmwall2  1  0=3.0: 
chmwall2  1  1  =14.2; 
chmwall2  2  0  =L.O; 
chmwall2’2'  1  =14.2: 
chmwall2  35  0  =0.5: 


chmwall2'2i  1  -14.7. 


colon' CHMW  \LL21; 

poif2(4.chmwall2); 

poomacrLx(); 

poDviewoortt ); 
popmatrix( ); 
closeobj(); 

}  /*  makehousel  */ 
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F.  Help.c 


/* 

This  module  creates  the  welcome  and  help  screen. 
*! 


^include  "road.h" 

static  int  parray[4][2j  =  { {275. 600}, { 250,625}, {275.625} ,{300.600} } ; 
static  int  parrayl  4] [2  =  {{275, 475}, {250, 500}, {275, 500}, {300, 475}}; 


WELCOME  DISPLAY 


welcome() 

{ 


*  Loop  until  we  get  a  mouse  button  hit  * 

colon' YELLOW); 

clear(); 

color(BLUE); 

rectfi(200.625,300,700): 
rectfi  (200. 600, 2  25,625); 
polf2i(4,parray); 

rectfi  (325, 600, 425,700); 
rectfi  (4  50, 600, 550, 700); 
rectfi  (575, 600, 675, 700); 
polf2i(4,parrayl); 

rectfi  (200, 475. 225,500); 
rectfi  (200. 500, 300, 575); 
rectfi  (325,475,425,575); 
rectfi(450, 475, 550.500); 
rectfi  (450. 500, 475, 575); 
rectfi  (575, 475, 675,500); 
rectfi  (575,500,600,575); 
rectfi  (700,52  5,800,575); 
rectfi  (737, 475,762,525); 


color(  YELLOW); 
rectfi(225, 650, 275,675); 
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rectfi  (350,625,400,675); 
rectfi(475, 600,525, 625); 
rectfi  (475, 650. 525, 675); 
rectfi  (5  75, 625. 600, 675); 
rectfi  (625, 625,650, 67  5); 
rectfi  (225, 525, 275, 550); 
rectfi  (350, 52  5, 400, 550); 
rectfi  (350, 475. 400, 500); 
rectfi  (725, 550, 77  5, 575); 

color(BLACK); 

cmov2i(200.350); 

charstrf"  Welcome  to  the  world  of  ROAD  RALLY"); 
cmov2i(200,325); 

charstr( "You  drive  a  car  on  a  road  controlling"); 
charstrf"  us  speed  and  direction  with  the"): 

cmov2i i  200.300); 

charstrf "mouse.  To  exit  the  program"); 

charstr;"  at  any  rime  press  all  three  mouse  simultaneously."); 
cmov2i(200,275): 

charstrf" After  rhe  bell  ring,  to  continue  with  the"): 
charstri"  program  press  me  left  mouse  button."); 

cmov2i(200,250); 

charstr("HELP  is  available  by  pressing  the  keyboard  key  h"); 
charstrf"  while  the  car  is  moving."); 

linewidth(5); 

cmov2i(200,l75); 

charstr("Author  :  Tan  Chiam  Huat"): 

color(RED); 

cmov2i(200, 150); 

charstr("This  image  is  contributed  by:  Mike  Whiting"); 

color(BLACK) ; 

linewidth(l); 

swapbuffersf); 

}  /*  welcome  */ 

/************************************************»************ 


HELP  DISPLAY 


************************************************************* 


/ 


help() 

{ 

Icoord  x  =  100; 
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Icoord  y  =  340; 

Icoord  iy  =  22; 

/*  Loop  until  we  get  a  mouse  button  hit  */ 

while  (getbutton(MOUSEl)  ==  0  &;<k  getbutton(MOUSE2)  ==  0  &:&: 
getbutton(MOUSE3)  ==  0) 

{ 

pushmatrLx(); 
pushviewport(); 
viewport(0,  1023.  0.  380); 
ortho2(0.0.  1023.0.  0.0.  380.0); 
color(  WHITE); 
clear(); 

color(BLACK); 

linewidth(5); 
cmov2ifx.  v); 

charstrf "HELP  INFORMATION;  Press  any  mouse  button  to  continue"); 
cmov2i(x,  v  -  iy); 

charstr["KEY  REMARK"); 


cmov2i(x.  y  -  2  iy); 

charstr("a  or  A  or  Left  button  ;  Accelerate"); 


cmov2i(x,  y  -  3  *  iy); 

charstr(nb  or  B  or  Middle  button  ;  Brake"); 
cmov2i(x,  y  -  4  *  iy); 

charstr("c  or  C  :  Clock  switch"); 


cmov2i(x}  y  -  5  *  iy); 

charstr("e  or  E  or  Right  button  :  Emergence  Stop"); 


cmov2i(x,  y  -  6  *  iy); 

charstr("h  or  H  :  Help"); 


cmov2i(x,  y  -  7  *  iy); 

charstr("o  or  O  :  Odometer  reset"); 

cmov2i(x,  y  -  8  *  iy); 

charstr("q  or  Q  ;  Autopilot"); 


cmov2i(x,  y  -  9  *  iy); 

charstr("s  or  S  ;  Sound  danger"); 

cmov2i(x,  y  -  10  *  iy); 

charstr("t  or  T  :  Timer  (Integration)"); 
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cmov2i(x,  y  -  11  *  iy); 
charstr("z  or  Z 


:  Information"); 


cmov2i(x,  y  -  13  *  iy); 

charstr("To  TURN  LEFT  :  Move  mouse  to  the  left"); 

cmov2i(x,  y  -  14  *  iy); 

charstr("To  TURN  RIGHT  :  Move  mouse  to  the  right") 

linewidth(l); 
popviewportf ); 
popmatrix(); 
swapbulfers(); 

}  *  while  * 

*  help 
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G.  Letter,  c 


/*  This  routine  is  written  for  the  IRIS-2400 
This  is  routine  letter.c... 

This  file  supports  routine  title. c,  which  constructs  the 
title  page  of  the  font  building  utility  "BUILDFONT." 

This  file  contains  routines  to  display  block  alphabetic  characters 
suitable  for  inclusion  into  graphics  objects.  These  letters  are 
used  instead  of  IRIS  FONTS  when  one  desires  to  treat  them  as 
graphics  objects  that  can  be  rotated,  scaled,  etc.  (font  char¬ 
acters  can’t) 

This  file  includes  routines  for  27  characters,  "A"  through  nZ", 
and  also  and  "  "  (blank)  (but  not  "GV'Q'V'VV'  W">"XI,,Z") 

The  routine  draws  the  desired  letter  in  absolute  coordinates, 
tn  the  center  of  the  disolay 

To  use  these  routines,  the  color  desired  for  the  letter  must 
be  specified  when  the  object  is  created  (in  the  user  program j, 
and  the  desired  backgound  color  must  be  passed  to  the  routine. 

Original  version  written  by  J.  Artero  and  R.  Kirsch:  current 

version  written  by  L.  Williamson 


*  / 

^include  "gl.h" 

^include  "device. hM 

letter(asci,backcolor) 

int  asci;  /*  index  of  character  we  want  to  display  */ 

Colorindex  backcolor;  /*  specified  background  color  */ 

{ 


Coord  box  [8] [2 j ;  /*  vector  of  coordinates  forming  the 

vertices  of  a  letter  object  */ 


switch(asci) 

{ 


case  ’Ah 

box[0]  [0] =4 .6875; 
box[0]jl]=3.25; 
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box[l][0]=4.9375; 
box  [l][l]=4.25: 
boxj2][0]=5.0625; 
box  [2][l]=4.25; 
box[3]  [0] =5 .3 125; 
box  [3][l]=3.25; 
polf2(4,box); 

color(backcolor); 
box[0][0)=4.8125; 
box[0][ll=3.25: 
boxjlj[0]=4.S4375; 
boxll1  1  =3.375: 
box[2][oj=5. 15625; 
box  (2][lj=3.375: 
box[3][0]=5.1S75; 
box(3!  [  1  =3.25; 
polf2(4,box): 

box'O  ^0!=4.875: 
box  0  1  =3.5: 
boxi  1  101=5.0: 
box;  1' 1 1  =4.0: 
boxi2i  1 0 ! =5 . 125; 
box!  2  1 1=3.5: 
Doif2l  2,  box): 

break; 

case  ’B’: 

box[0][0'=4.6875; 
box[0’[lj  =  3.25; 
box[l]^0!=4.6875; 
box[l  1  =4.25; 
box[2][0|=5.1875; 
box  [2][l]=4.25; 
box[3]  [0]=5 .3 1 25 ; 
box[3][l]=4.125; 
box(4]  0] =5 . 3 1 25; 
box[4][l]=3.375; 
box[5]  [0]=5 . 1875; 
box[5]  [  1  ] =3.25; 
polf2(6,box); 

color(backcolor); 
box[0]  [0]  =5 .25 ; 
box[0  1  ] = 3 . 8 125; 
box[l][0]  =  5.3125; 
box[l][l]=3.875; 
box[2]  [0]=5.3 125; 
box[  2]  [  1  j =3 .75 ; 
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polf2(3,box); 

box[0][0]=4.8125; 
box  0]  [  1  ] =3 .375 ; 
box[  l]  [0]  =4 . 8 1 25 ; 
box[  1  ]  [  1  ] =3 . 75 ; 
box  j  2]  [0] =5 . 1 25 ; 
box[2][l]=3.75; 
box[3][0]=5.1875; 
box!  3][lj=3.6875: 
box  4![0l=5. 1375: 
boxi  4  j  f  11  =  3.4375: 
box  5 i  1 0 1 =5 . 125: 
box5l  1  i=3.375: 
polf2(6.box): 

box,0l|0l=4.8  125: 
boxiOjjl!  =3.875: 
box  1  j  f  0 1  =  4.8125: 
boxt  III j  11=4. 125: 
box  2 ! 1 0 1  =  5 . 125: 
ooxi2!i  1 1=4.125: 
boxi3!j0i=5. 1875: 
box  i  .*5 1 1 1  =4.0625: 
boxi  4 1  jO  =5.1875: 
ooxi  4 1 1 11=3.9375: 
box,5|[0!  =5.125: 
box  5] [  1  j =3. 87 5 ; 
polf2(6,box): 

break; 

case  ’C’: 

box^0][0l  =  4.6875; 
box[0]  [  1  ] =3 . 375; 
box[l][0>=4.6875; 
box[l]  [  l]  =4. 125 ; 
box[2]  [0]  =  4 . 8 1 2  5 ; 
box[2][l]=4.25; 
box  j  3]  [0] =5 . 1 875 ; 
box[3](l]=4.25; 
box[4][0j=5.3125; 
box[4)[l]=4.125; 
box[5j  [0]=5.3125; 
box]  5]  [  1  j =3 . 375 ; 
box[6]  [0]  =5. 1 875 ; 
box[6][l]  =  3.25; 
box[7][0j=4.8125; 
box[7][lj=3.25; 
polf2(8,box); 
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color(backcolor); 
box[0]  [0]  =4.8 125; 
box[0]  [  l]  =  3.4375; 
boxjl]  [0]=4.8 125: 
box  [  1 )  [  1  ] = 4 . 06  2  5 ; 
box[2j(0  =4.875; 
box[2][l]=4.125; 
box(3][0j  =  5.125; 
box[S][lj=4.125; 
box!4M0]=5.1875; 
boxi4  ll  =4.0625: 
box  5t  0;=5. 1875. 
boxi5i  1  =3.4375 
box ;  6 1  [  0 1  =  5 . 1 2  5  : 
box  6l  1  =3. 375: 
box  7  0  =4.375: 
box  7  1  =3.375; 
poif2(8.boK): 


recu(  5.i  8  75. 5. 5.5.5125. 4.001; 


oreaK. 


case  D’ 


box: 0 1 1 0 1  =4  6875 
dox  01!  1  =3.25. 
boxilj[0  =4.6875: 
boxjl  1  =4.25; 
box’  2j[0]  =5.1875: 
box[2][l)=4.25; 
box  3  0  =5.3125; 
boxj3][l  1=4.125; 
box!4  0  =5.3125; 
box  4  1  =3.375; 
box '  5 ! » 0  ] = 5 . 1875; 
box  [5  ]  [  1  =3.25; 
polf2(6,box); 

color(backcolor); 
box[0]  [0| =4 . 8 1 25 ; 
box  0  lj=3.375; 
boxjl]  [0j=4. 8125; 
boxjl][l]=4.125; 
box[  2]  [0] =5 . 1 25 ; 
box[2][l]=4.125; 
box[3)  [0]  =  5 . 1 875 ; 
box[3][l]=4.0625; 
box  [4]  [Oi  =5 . 1 875 ; 
box[4  ]  [  1 ;  =3.437  5 ; 
box[5][0]=5. 125; 
box;5][lj  =  3.375; 
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polf2(6,box); 

break; 


case  ’E’: 

rectf(4. 6875. 4. 125.5.25,4.25); 
rectf  (4. 6875, 3. 25. 5. 3 125, 3. 375); 
rectf  (4. 6875, 3. 25, 4. 8 125,4. 25); 
rectf  (4. 81 25. 3. 75, 5. 0625,3. 875); 

break: 

case  ’F': 

rectf  (4. 6875. 3. 25.4. 8 125.4. 25): 
rectff  4. 6875.4. 125.5.3125.4.25); 
rectf  (4. 8 125. 3. 75.5. 125.3.875): 

break: 

case  ’H’: 

rectf(4. 6875. 3. 25.4. 8125.4. 25): 
rectff  4. 3 125.3.6875.5. 1875.3.312 
rectf(5  1875.3.25.5.3125.4.25): 

break; 

case  ’I’: 

rectf(4.6875,4. 125,5. 3125.4.25); 
rectf(4.6875.3.25,5.3125.3.375); 
rectf(4.9375,3.25,5.0625,4.25); 

break; 

case  ’J’: 

box[0)  [0] =4.6875 ; 

box[0)[lj=3.375; 

box,l][0;=4.6875; 

box[l)[l)=3.625; 

box[2][0]=5.3125; 

box[2)[lj=3.625; 

box[3]  [0]  =5. 3 125; 

boxj3][lj  =  3.375; 

box[4)  [0]  =5 . 1 875 ; 

box[4][lj=3.25; 

boxj5][0]=4.8125; 

boxf  5  j  [  1  ] =3.25 ; 

polf2(6,box); 


rectf(  5.2, 3.625,5.3 125, 4.25); 

color(backcolor); 
box[0][0j=4.8l25; 
box[0]  [  1  ]  =  3 .4375; 
boxj  l]  [Oj =4. 8 1 25 ; 
boxj  l]  [  1  ]=3.625; 
boxj  2]  [0] =5 . 1 875 ; 
box[2]  [  1  j=3.625; 
box  3]  01=5.1875; 
box!3i  1  ] =3.437  5; 
box  4  01=5.125; 
box  4  11  =  3.37 5; 
box;  5j  01=4.875: 
box  5 1  1  =3.375; 
polf2(6,box): 

break; 

case  'K'; 

reccff  4 .68  75. 3. 25.5. 3 125.4. 25 ) ; 

colon  backcoiori: 
boxiOl  0i=4.8125; 
box !  0 1 !  L  1  =  3.875; 
boxtlj  01=4.8125: 
boxjlj  lj=4.25; 
box[2][0]  =  5.125; 
box[  2]  [  1  =4.25; 
polf2(3.box); 

box[0][0]=5.02; 
box[0]  [1  =3.875; 
boxj  l]  jOj =5 . 3 12  5 ; 
box:  1  ]  j  1 '  =4 . 25; 
box[2][0]=5.3125; 
box(2][l]=3.25; 
polf2(3,box); 

box[0]  [0]=4 .8 1 25; 

box[0]jl]=3.25; 

boxjl][0;=4.8125; 

boxj  l][lj  =  3.625; 

box|2][0]=4.9; 

box[2][l]=3.74; 

box[3]|0]=5.14; 

boxj  3]  j  l] =3 . 25; 

polf2(4,box); 

break; 
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case  ’L’: 


rectf(  4.6875, 3. 25, 4. 8 125,4. 25); 
rectfj  4.6875, 3. 25, 5. 3 125, 3. 37  5); 

break; 

case  ’M': 

rectf(4.6875.3.25.5.3125,4.25); 

coior(backcoiorj; 
box  1 0  j  1 0  i = 4 . 68  7  5 : 
box  1 0  j  [  1  i = 4 . 2  5 ; 
boxlll  0i=5.3125: 
boxjlj  1  =4.25: 
box, 2'  0 i  =  5 .0: 
box!  2lili=3.75: 
poif2(3.box): 

box’0l|Q»=4.8125; 
boxiOII  1=3.25: 
box!  1 1  i0i=4.bl25: 
boxi  l!il  1=3.5 125; 
box  1 2 1  f  0  i = 5 . 1 2  5 ; 
box!  21]  1!  =3.25: 
po  if  2  (3,  box); 

box[0][0  =4.875; 

box[0][lj=3.25; 

box[l][0]=5.1875; 

box[l][l]  =  3.8125; 

boxl2][0|=5.1875; 

boxj2][l]=3.25; 

polf2(3,box); 

break; 

case  ’N’: 

rectf(4.6875,3.25/  3125,4.25); 

color(backcolor); 
box[0j[0]=4.8125; 
box[0]  [  1  ] =3 .25 ; 
box[  l]  [0]=4 .8 125 ; 
box[l][lj=3.9375; 
box[2][0]=5.1875; 
box[2  ]  [  l] =3 .25 ; 
polf2(37box): 

box[0][0]  =  4.8125; 
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box(0][l]=4.25; 

box*  l][0j  =  5. 1875; 

box[l][l]=4.25; 

box[2][0]=5.1875; 

box[2|[l]=3.5625; 

polf2(3,box); 

break; 

case  J0?: 

box  0 1 [ 0 1 = 4 . 6875: 
boxiOII  ll  =  3.375: 
box;  l|[0|=4. 6875: 
box:  1 J  [  lj=4 .125: 
box:  2l  [01=4 .8125: 
boxi  2 1 1 11  =  4.25: 
ooxi3IIOl=5.1875: 
box:  3!  1  =4.25. 
box  4i 1 01  =5. 3 125: 
box!  *4 1 1  li=4. 125, 
boxi5i  01  =  5.2 125: 
ooxi5i  11=3.375: 
box  oil 01  =5. 1875: 
ooxi  6i 1  II  =3.25: 
ooxi  7(101=4.8125; 
dox  7  1  =3.25: 
polf2(8,box); 

color(backcolor); 
box[0][0]=4.8125; 
box[0][l]  =  3.4375; 
boxjl][0j=4.8125; 
boxjl)[l]=4.0625; 
box[2j  [0] =4 .875; 
box[2][l  j=4.125; 
box[3][Oj  =  5.125; 
box[3][l]  =  4.125; 
box;4j[0)=5.1875; 
box  4j[lj=4. 0625; 
box[5]  [0] =5 . 1 875 ; 
box;5][l]=3.4375; 
boxj6][0]=5.125; 
box[6][l|=3.375; 
box[7]  [0] =4 .875; 
box[7]  [  l] =3.375; 
polf2(8,box); 

break; 

case  JP5: 


166 


box[0][0]=4.6875; 

boxfO]  [  ll =3.25; 

box[l][oj=4.6875; 

box[l](lj=4.25; 

box[2]  [oj =5. 1 875; 

box(2][lj=4.25; 

box[3][0]=5.3125; 

box(3][lj=4.125; 

box  4] [0  =5. 3125; 

box  4  1  i  =3 .25: 

polf2(5.box); 

color(backcolor); 
boxi0][0!=4.8125: 
box  0]  jli=3.25; 
boxil  0i=5.3125; 
box  1 !  [  1 ;  =3.8125: 
box  2itO!=5. 3125: 
doxi2!  1  =3.25; 
polf2(3,box): 


Doxl0H0l=4.S125: 
boxiOi  11=3.8125: 
boxil  01=4.8125; 
boxil  I  1  i=4.125: 
doxi  2!  1 01=5.125: 
box  2|  1]=4.125; 
box|3![0]=5.1875; 
box(3][l]=4.0625; 
box[4j[0  =5.1875; 
boxi4|(l)=3.875; 
box!5][0j=5.125; 
box;  5]  j  1  =3.8125; 
polf2(6,box); 

rectf(4.8125,3.25,5.3125,3.6875); 
break; 
case  ’R’: 

box(0][0]=4.6875; 

box[0][l]=3.25; 

box'  l'[0l=4. 6875; 

boxj  1  j  [  1  j  =4.25; 

box[2]|oj=5.1875; 

box  2] [ l]  =4 .25; 

box[3][0]=5.3125; 

box[3](l!=4.125; 

box|4][0j=5.3125; 

box(4  ]  [  1  j  =  3.25; 

polf2(5,box); 


color(backcolor); 
box  0][0]=5.1875; 
box[0)[  lj  =  3.625; 
box[l](0]=5.3125; 
box[l][lj=3.75; 
box[2][0]=5.3125; 
box[2][l]=3.25; 
polf2(3,box); 

box  0][0]  =  4. 8125; 
boxfOj!  1=3.75; 
box  1  oj  =  4.8l25: 
boxil  1  j  =4 .125: 
box  2j [0] =5. 125; 
box  2][1]=4.125; 
box  3ljoi  =  5. 1875: 
box  3  11=4.0625: 
box  4  01  =  5.1875: 
box  4  1  =3.8125: 
box  5  01=5. 125: 
box  5  i;=3.75; 
poif2(6.box): 

box  0  01=4.8125: 
boxiOi  1  =3.25: 
boxl  1'  01  =  4.8125: 
box  1  1  =3.625; 
box  2,  0]=5.05; 
box[2]  [  1  ] =3 .625; 
box  3]  oj=5.l75; 
box!3  1^  =  3. 25; 
polf2(4,box); 

break: 

case  ’S’: 

box  [0]  [0]  =4 . 6875; 
box[0j  [  1  j =3 . 375; 
box|l]  0] =4 . 6875; 
box[lj  1  ] = 4 . 1 2  5 ; 
box[2]  [0] =4. 8125; 
box(2)  1  ] =4 .25; 
box[3][0]=5.l875; 
box[  3  ]  [  1  ]  =4 . 25 ; 
box[4][0j=5.3125; 
box|4}  l]=4.125; 
box  [5]  [0] =5. 3 1 25 ; 
box[5](l]  =  3.375; 
box  6] [0] =5. 1875; 
box[6]  1  ]  =  3 . 25; 
box|7j[0]=4.8125; 


box[7][l]  =  3.25; 
poif2(8,box); 

color(backcolor); 
box[0](0]=4.8l25; 
box[0][l]=3.4375; 
boxjl]  [oj=4.8125; 
box  [lj[lj=3.75; 
boxj  2  j  [0] =5. 125; 
box[2][l]=3.75: 
boxj3i[0i=5.1875: 
box(3j[lj=3.6875: 
boxi4l[0l=5.1875; 
box  (4j[lj=3.4o75; 
box!  5  ]  [Oi =5 . 125 ; 
boxi5  1  =3. 375; 
box'6i  j0|=4.875: 
boxib!  L =3.375; 
poif2(  7.  box): 

box  1 0 1  f  0  ( = 4 . 3 1  *2  5 : 
boxiOl  i !  =0.9375 ; 
boxil:  01=4.8125: 
box  1  11  =  4.0625: 
boxi2!  0i=4.875: 
box  2!  1  !  =  4. 125: 
dox|3|  0  =5. 125; 
box  [oj[lj=4.125; 
box  4  O' =5 . 187 5 ; 
box[4][l]=4.0625; 
box[5][0]=5.1875; 
box[5j  lj=3.875; 
box[6]  [0]  =4.875; 
box[6i  l] =3.87 5; 
polf2(7,box); 

box[0][0]=4.6875; 
box[0]  [  1  j =3. 5625; 
boxil  0]=4. 6875; 
box|l][l]=3.875; 
box[2][0)=4.8125; 
box[2]  [  l] =3. 75 ; 
box[3][0]=4.8125; 
box!3]l]=3.5625; 
polf2(4,box); 

box  j  0]  [0] =5. 1 875 ; 
boxloj  [  l]  =3. 875; 
box  l][0]=5. 1875; 
box  1  ]  [  1  =4.0; 
boxf  2]  [0]  =5 . 3 1 25; 
box!2j[l  =4.0; 
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box  [  3  ]  [  0 1  =  5 . 3 1 2  5 ; 
box[3 }  [  1  j =3 . 75 ; 
polf2(4,box); 

break; 

case  ’T’: 

rectf(4.6875.4.l25,5.3125,4.25); 
rectf)  4. 93  75, 3. 25, 5. 062  5, 4. 2  5); 
break; 

case  Xr: 

box;0l  |0‘=4.6875: 
boxjolj  1  =3.375; 
boxi  1  0i  =  4.6875: 
box  I  III  —4.25; 
boxi  2!  101=5.3125: 
boxi  2  1 1=4.25: 
box  31101=5.3125: 
boxi  3 1  1  —3  *25: 
boxi4!  0  =4.8125: 
ooxi4i  1  =3.25: 
poif2(  5.  boxi: 

colors  backcolorj: 
box[0)[0j=4.8125: 
box[0  j  [  1  =3.4375: 
box[l][oj=4.8l25; 
box[l][l=4.25: 
box  2  ! 0  =5.1875; 
box[2]  [  1  ]  =4 .25: 
box[3][0i=5. 1875; 
box[3][lj=3.5325; 
box[4  j  [0}=5.0l ; 
box[4][lj  =  3.375; 
box[5][0j=4.875; 
box[5][lj  =  3.375; 
polf2(6,b°x)‘? 

box[0][0]=5.0625; 
box[0]  jl)  =  3.25; 
box[l][0j=5.1875; 
boxjljj  l]=3.375; 
box[2][0]=5.l875; 
box[2][l)=3.25; 

polf2(3,b°x); 

break; 
case  ’Yb 
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box[0][0]=4.6875; 
box[0][lj=4.25; 
box[l](0]=4.9375; 
box[  1 J  [1  j =3.75; 
box[2]  [0]=5 .0625; 
box(2][l]=3.75; 
box[3][0]=4.8125; 
box[  3]  [  1  ] =4.25 ; 
polf2(4,box); 


boxtO'  OS =4 .937 5 ; 
boxfOj  [  1  =3.75; 
box|l'  0  =5. 0625; 
box  lj jl  =3.75: 
box|2S;0i=5.3125; 
boxf2j{  1  =4.25: 
box! 3 1  0 1  =5. 1875: 
box!  31  1  =4.25; 
polf2(4.box); 

rectff  4.9375,3.25.5.0625.3. 75) 
break: 

case  :  : 

rectf(4.9375,3.35.5.0625,3.60) 
rectf  (4.9375, 3. 90, 5. 0625, 4. 15) 

break; 

case  *  ’: 

break; 

}  /*  end  switch  */ 

}  /*  end  routine  "letter"  */ 


H.  Find_subgoal.c 


r 

Look  for  the  next  subgoal  along  the  road 

V 

^include  Mroad.h" 

static  Boolean  start  =  FALSE; 

find_subgoal(roadmap,  no_coord,  where,  tolerance,  pred  distance,  vx,  vy.  vz) 

float  pred  distance; 

float  roadmap  j[3j; 

float  tolerance; 

float  vx.  vv.  vz; 

int  no  coord,  where: 

float  dist,  temp; 
float  x.  y,  z: 
int  i; 


for  (i  =  where:  1  <  no_coord: - i) 

r  ~ 

x  =  roadmap  ii'O  -  vx: 
y  =  roadmap[ij[l  -  vy: 
z  =  roadmapji  2  -  vz; 
dist  =  sqrt(x*x  +  y  *  y ) ; 
temp  =  pred_distance  -  dist; 

/*  converts  negative  to  positive  * 
if  (temp  <  0) 

temp  =  -(temp): 

if  (Istart) 

{ 

/*  This  works  only  when  autopilot  is  turned 
on  for  the  first  time  on  the  first  stretch 
of  the  cicuit.  Problem  if  otherwise.  */ 

if  (temp  <=  tolerance  roadmap[i][l]  >  vy) 

{ 

start  =  TRUE; 
return(i); 

} 

} 

else 

if  (temp  <=  tolerance) 

{ 
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start  =  TRUE; 
return(i); 

} 


} 

/*  If  no  points  found,  return  an  error  code  */ 
return(-l); 

}  /*  find_subgoal  */ 
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I.  Map.c 


/* 


This  module  works  independently  from  the  rest  of  the  system. 
This  module  generate  the  road  map  for  autonomous  navgiation. 


^include  <stdio.h> 

^include  <math.h> 

main() 

{ 

FILE  “fp: 
int  i: 

Road  Specification  * 

*  Note:  Must  match  that  used  in  the  carsimu.c  program 
float  bendraaius  ~  SO.U: 
float  roaawidth  =  16.0: 
float  ten!  =  400.0: 
float  ien2  =  400.0: 
float  len3  =  400.0: 
float  len4  =  400.0: 
float  newx,  newy.  miss: 
float  calx.  caiy.  start_raa: 
float  perstep  rad; 

float  step  =  1.0;  /*  road  map  increment  step  * 

float  radl  =  bendradius  -  roadwidth/2; 
float  rad2  =  bendradius  -  roadwidth/2; 
float  rad3  =  bendradius  -  roadwidth/2; 
float  lastxvalue; 

float  lastyvalue;  * 

float  xl,  yl,  zl; 

float  x2,  y 2,  z2; 

float  x3,  y3,  z3; 

float  x4,  y4,  z4; 

float  x5,  v5,  z5; 

float  x6,  y6,  z6; 

float  x7,  y7.  z7; 

float  x8,  y8.  z8; 

/*  Road  Segment  Specifications  * / 

xl  =  0.0;  yl  =  0.0;  zl  =  0.0; 

x2  =  0.0;  y2  =  lenl;  z2  =  0.0; 

x3  =  radl;  y3  =  y2  radl;  z3  =  0.0; 

x4  =  x3  —  len2;  y4  =  y3;  z4  =  0.0; 

x5  =  x4  -+•  rad 2;  y 5  =  y4  -  rad 2;  z5  =  0.0; 

x6  =  x5;  y6  =  y5  -  len3;  z6  =  0.0; 

x7  =  x5  -  rad3;  yl  =  y6  -  rad3:  z7  =  0.0; 

x8  =  x7  -  len4;  y8  =  y7;  z8  =  0.0; 
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fp  =  fopen(fTroadmapM,nwn); 
newv  =  y  1; 

for  (i  =  0;  newy  <=  y2;  — ri) 

{ 

#ifdef  DEBUG 

printf(M%.2f  %.2f  %.2f\nM,xl,newy,zl); 

#endif 

fprintf(fp,"%.2f  %.2T  %.2f\n,fJxllncwy,zl); 
lastyvalue  =  newy; 
newv  H-  =  step; 

} 

newv  =  lastyvalue: 
miss  =  v2  -  newy; 

#ifdef  DEBUG 

printf(Mmissl  %.2f  nH,miss); 

*=endif 


start  rad  =  0; 
if  (miss  >  0) 

{ 

start  rad  =  miss/ rad  1; 
calx  =  cos(stari  rad); 
caiv  =  sin  (start  rad); 
newy  —  =  caiv: 
newx  caix: 
ftifdel  DEBUG 

printf("%.2f  %.2f  %.2f\nM,x2-hnewx,y2-rnewy,z2); 

#endif 

fprintf(fp.M%.2f  %.2f  °c.2f\n",x2+newx,y2+newv,z2) ; 

} 

perstep  rad  =  step/ rad  1; 
for  (i  =  0:  newx  <=  x3;  — fi) 

{ 

start  rad  +=  perstep  rad; 
calx  =  radl  *  cos(start_rad) ; 
caiv  =  radl  *  sin(start  rad); 
lastxvalue  =  newx; 
lastyvalue  =  newy; 
newy  =  y2  4-  caly; 
newx  =  x2  ^  (radl  -  calx); 
if  (newx  <  x3) 

{ 

#ifdef  DEBUG 

printf(M%.2f  %.2f  %.2f\n", newx, newy, z2); 

#endif 

fprintf(fp,"%.2f  %.2f  /o.2f\n", newx, newy, z2); 

} 

} 

newx  =  lastxvalue; 
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newy  =  lastyvalue: 
miss  =  x3  -  newx; 

#ifdef  DEBUG 

printf(nmiss2  %.2f\nff.miss); 

#endif 

if  (miss  >  0) 

{ 

newx  =  x3  -f-  miss; 

#ifdef  DEBUG 

pnntf(n%.2f  %.2f  %.2f\ nf\newx.y4,z3); 

#endif 

fprintf(fp,M%.2f  %.2f  %.2f\n",newx,y4,z3); 

} 

for  (i  =  0;  newx  <  =  x4;  — -^i) 

{ 

las  tx  value  —  newx: 
newx  — =  step: 
if  (newx  <=  x4) 

{ 

-ifdef  DEBUG 

printffHiro.2f  %.2i'  °7;.2f'  n?\newx,y4,z3): 

-end  if 

fpnncftfD. !?C:o.2f  nft.newx.y4.z3); 


} 

newx  =  lastxvalue: 
miss  =  x4  -  newx: 

#ifdef  DEBUG 

printf(nmiss3  9c.2f\nfr,miss); 
fendif 

start  rad  =  0; 
if  (miss  >  0) 

{ 

start  rad  =  miss/rad2: 
caly  =  rad2  *  cos(start  rad); 
calx  =  rad2  *  sin(start_rad); 
newy  =  y4  -  (rad2  -  caly); 
newx  =  x4  —  calx; 

#ifdef  DEBUG 

printf(n%.2f  %.2f  %. 2f\n,!, newx. newy, z4); 

#endif 

fprintf(fp?,f%.2f  %.2f  %.2f\n", newx, newy, z4); 

} 

perstep  rad  =  step/radl: 
for  (i  =  0;  newy  >=  y5;  -(--hi) 

{ 

start  rad  t=  perstep  rad; 
caly  =  rad2  *  cos(start  rad); 
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calx  =  rad2  *  sin(startrad); 
lastxvalue  =  newx; 
lastyvalue  =  newy; 
newx  =  x4  t  calx; 
newy  =  y4  -  (rad2  -  caly); 
if  (newy  >=  y5) 

{ 

fifdef  DEBUG 

printf(M%.2f  %.2f  %.2f\n", newx. newy, z4); 

#endif 

fprintf(fp,n  %.2f  %.2f  %. 2f\nM, newx. newy. z4 1. 

} 

} 


newx  =  lastxvalue: 
newy  =  lastyvalue; 
miss  =  newy  -  v5: 
fifdef  DEBUG 

pnntf(Mmiss4  ^c.2f  nTt.miss): 

=  enaif 

if  (miss  >  0) 
r 

i 

newy  =  yo  —  miss: 

fifdef  DEBUG 

prnuf(M<> o.2f  %.2f  %. 2f\nn. newx, newy. z5): 

fpendif 

fprintf(fp,"/?).2f  %.2f  %.2f\n",newx,newv,z5); 

} 

for  (i  =  0;  newy  >=  y6;  +-ri) 

{ 

lastyvalue  =  newy; 

newy  -=  step:  * 

if  (newv  >=  v6) 

{ 

#ifdef  DEBUG 

printf(,!/o.2f  %.2f  %.2f\n",newx,newy,z5); 

#endif 

fprintf ( fp,  1T%. 2f  %.2f  %.2f\n", newx, newy. z5); 

} 

} 

newy  =  lastyvalue; 
miss  =  newy  -  v6; 

#ifdef  DEBUG 

printf(Mmiss5  %.2f\n,,,miss); 

#endif 

start_rad  =  0; 
if  (miss  >  0) 

{ 

start_rad  =  miss/rad3; 


177 


calx  =  rad3  *  cos(start  rad); 
caly  =  rad3  *  sin(start  rad); 
newx  =  x6  -  (rad3  -.calx); 
newy  =  v6  -  caly; 

#ifdef  DEBUG 

printf(n%.2f  %.2f  %. 2f\nn, newx, newy ,z5); 

#endif 

fprintf(fp,f,%.2f  %.2f  %.2f\n'\ newx, newy, z5); 

} 

perstep  rad  =  step/rad3. 
for  (i  =  0;  newx  >=  x7.  —  —  1) 

{ 

start  rad  —  =  perstep  rad: 
calx  =  rad 3  x  cos(start_rad); 
caly  =  rad3  *  sinfstart  rad); 
lastxvalue  =  newx; 
lastvvalue  —  newy; 
newy  =  vo  -  caly 
newx  =  xv  -  irad3  -  calx); 
if  (newx  >—  x 7 ) 

~ifdef  DEBUG 

printf(nC"b.2f  %.2f  °7).-U  nn. newx. newy, zr>); 

-endif 

fpnntf(fp/:C7.2f  cy2f  (vT.2f  n;!  .newx.  newv  zo ) 

) 

} 


newx  =  lastxvalue; 
newy  =  lasty  value; 
miss  =  newx  -  xT; 

#ifdef  DEBUG 

printf(Mmiss6  %.2f\nf,.miss);  % 

£endif 

if  (miss  >  0) 

{ 

nevvx  =  x7  -  miss; 

#ifdef  DEBUG 

prmtf(n%.2f  %.2f  %.2f\nn,newx,y8,z8); 

#endif 

fprintf(fp,M%.2f  %.2f  %.2f\nM,newx,v8,z8); 

} 

for  (i  =  0;  newx  >=  x8;  -H-i) 

{ 

lastxvalue  =  newx; 
newx  -=  step; 
if  (newx  >=  x8) 

{ 

#ifdef  DEBUG 
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printf(n%.2f  %.2f  %.2f\n'\newx,y8,z 8); 

#endif 

fprintf(fp.,T%.2f  %.2f  %.2f\nf',newx,y8.z8) 

} 

} 

newx  =  lastxvalue; 
miss  =  newx  -  x8; 

#ifdef  DEBUG 

printf(nmiss7  %.2f\nn,miss); 

#endif 

fclose(fp): 

}  /  *  main  */ 
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J.  Road.h 


typedef  float  Dimension; 

^include  "gl.h" 

^include  Mdevice.hM 
^include  "math.h" 

^include  Mtime.hM 
^include  r,stdio.hM 

^define  SYSTEM_ORDER  4 
^define  MOUNTAIN  8 

^define  MOUNTAINl  9 

#define  SKY  10 

^define  FIELD  11 

^define  WARN  12 

^define  WALL  1C 

^define  SIDEWALL  14 
-define  ROOF  15 

^define  WINDO  W  16 

=denne  CHMWALLl  IT 

-define  CHMWALL2  18 

-define  SIDEROOF  19 

-define  FRAME  20 

^define  SIDEWALL  1  21 

^define  WALLl  22 

^define  ROOFl  23 

^define  FRAMEl  24 

^define  WINDOWl  25 

^define  MAXFUEL  3000.0 

^define  PI  3.14 
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K.  Makefile 


CFLAGS  =  -Zf 

SRCS  =  other. c  \ 
integrate. c  \ 
display. c  \ 
letter.c  \ 
help.c  \ 
find  subgoal. c 
circuit. c 
carsimu.c 

OBJS  =  other. o 
integrates 
displays 
heip.o 
carsimu.o 
find  subgoai.o 
circuits 
letters 

carsimu:  SfOBJSi 

cc  -o  carsimu  S  (OBJS!  -Zf  -Zg  -on 


SfOBJSl:  -oaci.h 


* 
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